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Abstract 

Dynamic  systems  which  undergo  rapid  motion  can  excite  natural  frequencies  that 
lead  to  residual  vibration  at  the  end  of  the  motion.  This  work  presents  a  method 
to  shape  force  profiles  that  reduce  excitation  energy  at  the  natural  frequencies  in 
order  to  reduce  residual  vibration  for  fast  moves.  Such  profiles  are  developed  using  a 
ramped  sinusoid  function  and  its  harmonics,  choosing  coefficients  to  reduce  spectral 
energy  at  the  natural  frequencies  of  the  system.  To  improve  robustness  with  respect 
to  parameter  uncertainty,  spectral  energy  is  reduced  for  a  range  of  frequencies  sur¬ 
rounding  the  nominal  natural  frequency.  An  additional  set  of  versine  profiles  are 
also  constructed  to  permit  motion  at  constant  speed  for  velocity-limited  systems. 

These  shaped  force  profiles  ate  incorporated  into  a  simple  closed-loop  system 
with  position  and  velocity  feedback.  The  force  input  is  doubly  integrated  to  gener¬ 
ate  a  shaped  position  reference  for  the  controller  to  follow.  This  control  scheme  is 
evaluated  on  the  MIT  Cartesian  Robot.  The  shaped  inputs  generate  motions  with 
minimum  residual  vibration  when  actuator  saturation  is  avoided.  Feedback  control 
compensates  for  the  effect  of  friction.  L-sing  only  a  knowledge  of  the  natural  fre¬ 
quencies  of  the  system  to  shape  the  force  inputs,  vibration  can  also  be  attenuated  in 
modes  which  vibrate  in  directions  other  than  the  motion  direction.  When  moving 
several  axes,  the  use  of  shaped  inputs  allows  minimum  residual  vibration  even  when 
the  natural  frequencies  are  dynamiccdly  changing  by  a  limited  amount. 
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^transformation  of  positive  predicates  into  their  negative  duals  can  introduce 
universal  quantification  in  the  body  of  the  defining  clausq,  so.Walinsky  had  to  attack  this 
difficult  problem  as  wellrAConstructive  implementation  of  universal  quantifiers  in  general 
requires  unbounded  searches,  but  in  an  important  subcase  implementation  is  practical. 
Frequently,  the  universally  quantified  formuja  is  an  implication,  allowing  the  antecedent 
to  “filter”  instantiations  of  the  consequent'T^  He  modified^^the  SLD  resolution  procedure  to 
handle  this  situation,  and  explored  circumstances  under  which  the  resulting  executions 
are  practical. 

3.  Specific  Accomplishments 

Cliff  Walinsky’s  thesis  lays  solid  groundwork  for  systematic  study  of  negation  in 
logic  programming  that  preserves  the  declarative  nature  of  the  languages  like  pure 
PROLOG,  can  be  efficiently  executed  without  major  changes  to  present  interpreters,  and 
allows  programs  to  retain  their  constructive  solutions.  The  work  is  a  model  of  defining  a 
significant  research  topic,  exploring  and  changing  it  as^m^re  information  is  gathered,  and 
successfully  obtaining  results  of  the  kind  sought.  - _ _ 

AFOSR  support  not  only  made  possible  the  research  described  above,  but  also 
provided  for  extra  opportunities  for  Walinsky.  He  was  invited  to  attend  a  Washington, 
DC  workshop  as  student  observer.  He  was  able  to  attend  two  major  conferences  (one  an 
international  gathering  in  Australia  which  otherwise  would  have  been  beyond  possibility), 
to  meet  and  interact  with  other  researchers  (and  to  thereby  interest  others  in  his  ideas), 
and  ultimately  to  obtain  employment  in  a  prestigious  institution  where  he  will  continue 
to  be  a  productive  researcher.  Several  important  logic-programming  theoreticians  visited 
OGC  and  provided  contact  with  the  broader  research  community.  J-L.  Lassez  and  J. 
Jaffar  are  at  the  core  of  the  logic-programming  group  at  IBM  (Yorktown);  Lassez  invited 
Cliff  to  join  that  group  as  a  visitor  in  the  near  future.  R.  Topor  (Melbourne)  provided 
some  invaluable  early  direction  for  Cliff’s  work. 

The  one  area  in  which  Cliff  was  not  as  successful  as  we  had  hoped  was  in 
publishing  his  ideas.  He  submitted  papers  to  both  logic-programming  conferences,  but 
they  were  not  accepted.  The  field  is  new,  not  always  well  defined,  and  very  competitive. 
There  is  a  measure  of  politics  in  writing  acceptable  papers,  particularly  for  conferences 
with  a  high  rejection  rate.  (We  were  able  to  learn  that  the  difficulty  is  not  in  the  ideas, 
which  should  find  acceptance  in  the  more  controlled  arena  of  professional  journals.) 

The  technical  reports  being  submitted  under  separate  cover  give  a  complete 
description  of  constructive  negation: 

Walinsky,  C.,  “Constructive  Semantics  for  Negation”,  Report  CS/E  87-008,  Oregon 

Graduate  Center,  September,  1987. 

Walinsky,  C.,  “Constructive  Negation  in  Logic  Programs”,  Report  CS/E  87-009, 

Oregon  Graduate  Center,  September,  1987  (PhD  thesis). 
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Chapter  1 


1.1  Motivation: 

The  advent  of  microprocessor  technology  has  brought  about  an  entirely  new  way  to 
control  production  machinery.  No  longer  do  control  engineers  have  to  rely  on  analog 
circuits  for  controlling  dynamic  systems.  Now,  computers  can  be  programmed  and 
reprogrammed  to  produce  a  wide  range  of  control  actions  in  real  time.  Micropro¬ 
cessor  technology  has  enabled  the  power  of  computers  to  be  cheaply  installed  in 
many  dynamic  systems.  These  capabilities  have  made  the  newly-developing  field  of 
robotics  possible.  Robots  and  other  computer-controlled  machines  have  become  the 
dominant  components  in  automating  production  processes. 

.\long  with  the  opportunities  that  these  microprocessor-controlled  machines  bring 
has  come  a  new  set  of  challenges.  For  robots  to  perform  assembly  tasks  economi¬ 
cally  they  must  be  able  to  move  from  place  to  place  very  quickly.  Such  fast  motions 
will  excite  vibrations  in  the  moving  elements.  Since  robot  structures  are  typically 
only  lightly  damped,  these  oscillations  require  additional  time  to  settle  and  hence 
delay  the  start  of  the  next  task.  Since  each  relative  motion  excites  a  different  set  of 
frequencies,  the  only  way  to  avoid  e.xciting  any  structural  modes  using  existing  con¬ 
trollers  is  to  move  sufficiently  slowly.  To  achieve  fast  motions,  an  effective  motion 
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control  scheme  is  necessary  that  will  not  excite  the  system  natural  frequencies. 

The  goal  of  this  research  is  to  develop  methods  to  reduce  motion-induced  vibra¬ 
tion  during  fast  moves.  The  assumption  is  that  the  motion  itself  is  the  main  source 
of  system  vibration.  Thus,  force  prohles  which  do  not  contain  energy  at  the  system 
natural  frequencies  produce  motions  which  do  not  excite  structural  vibration  and 
hence  do  not  require  any  additional  settling  time.  The  approach  adopted  here  is 
to  remove  the  task  of  reducing  vibration  from  the  controller  which  ensures  accurate 
positions  in  the  presence  of  disturbances.  In  this  way,  a  simple  control  loop  can 
accomplish  accurate  positioning  without  the  complexity  required  to  suppress  vibra¬ 
tion.  Structural  oscillations  are  not  damped  out  but  avoided  by  judicious  choice  of 
force  inputs.  This  approach  works  as  long  as  the  motion  itself  is  the  only  source 
of  vibration,  which  is  usually  the  case  in  typical  positioning  systems.  Thus,  this 
work  develops  shaped  input  functions  that  can  reduce  residual  vibration  regardless 
of  which  controller  has  been  selected.  In  those  cases  in  which  even  optimal  regu¬ 
lators  fail  to  adequately  suppress  vibration,  these  inputs  can  significantly  improve 
performance. 

1.2  Literature  Review: 

Many  researchers  have  addressed  the  problem  of  controlling  vibrating  systems  such 
as  robots  and  space  structures.  .An  excellent  review  of  current  theory  and  practice 
in  dynamics  and  control  of  large  space  structures  has  been  presented  by  Nurre,  et  al. 
1  .  .A  review  of  general  control  strategies  is  given  by  Bryson  2|,  with  discussion  of 
specific  control  techniques  applied  to  flexible  systems  given  by  Seltzer  [.3l,  Croopnick, 
et  al.  4l.  .Joshi  and  Groom  Joi,  Meirovitch  and  Oz  '6]. 

These  control  strategies  can  be  loosely  organized  into  two  main  classifications: 
terminal  controllers  and  regulators.  Terminal  controllers  take  the  system  from  an 
initial  state  to  a  final  state  while  satisfying  some  optimization  criterion.  This  is 
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also  known  as  slewing  when  applied  to  space  structures.  Open-loop  slewing  is  ac¬ 
complished  using  a  control  input  that  is  strictly  a  function  of  time,  not  explicitly 
ot  the  system  states.  To  accomplish  slewing  maneuvers,  control  inputs  are  specified 
as  smooth  time  functions  to  minimize  excitation  of  system  resciaances.  .\spinwall 
7  shaped  such  a  profile  using  a  finite  Fourier  series  expansion  that  minimizes  fre¬ 
quency  content  over  a  wide  range  of  frequencies,  but  these  functions  take  twice  as 
long  as  the  corresponding  time-optimal  function  to  complete  the  motion.  Other  re¬ 
searchers  have  used  performance  indices’in  combination  with  Pontryagin's  principle 
to  generate  ’optimar'  control  functions  for  performing  open-loop  slewing  maneu¬ 
vers.  Various  performance  indices  and  system  models  have  been  used  by  researchers 
including  Swigert  8  .  Farrenkopf  [9],  Turner  and  .Junkins  [10],  Turner  and  Chun 
11  .  and  Alfriend  and  Longman  12'.  Swigert  also  included  a  penalty  on  residual 
amplitude  due  to  natural  frequency  changes  to  allow  limited  variations  in  frequency. 
Lisowski  and  Hale  Tdi  included  the  control  input  and  its  derivative  as  additional 
states  and  imposed  smooth  start  and  stop  transitions  on  the  control  input  function 
to  minimize  excitation  of  higher  resonant  frequencies. 

.Additional  open-loop  functions  have  been  developed  by  making  use  of  cam  profile 
shapes.  Such  a  forcing  function  was  developed  by  Makino  [I4j  to  drive  the  SC.ARA 
robot  arm.  Sehitoglu  and  .Aristizabal  [15]  used  a  cycloidal  motion  profile  to  generate 
smooth  motions.  However,  no  attempt  was  made  to  tune  these  functions  to  the 
dynamics  of  the  system  to  minimize  both  move  time  and  residual  vibration. 

.Another  open-loop  approach  has  been  to  use  a  series  of  appropriately-timed  step 
inputs  to  eliminate  residual  vibration  upon  completion  of  the  move.  This  technique 
has  come  to  be  known  as  posicast  control.  .A  detailed  presentation  of  this  approach 
is  given  in  Smith  IfiL  .An  e.xtension  of  this  concept,  incorporating  robustness  to 
parameter  uncertainties,  is  under  development  by  Singer  ^17|. 

In  addition  to  these  open-loop  slewing  functions,  researchers  have  also  developed 
closed-loop  slewing  strategies  that  utilize  time-varying  gains  on  feedback  states. 
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Breakwell  18]  deternained  t  hese  gains  as  a  function  of  remaining  time  to  maneuver. 
.Juang,  Turner,  and  Chun  I9.20i  determined  time-varying  gains  using  a  terminal 
constraint  on  the  performance  index  that  penalizes  residual  vibration.  Experimental 
results  using  this  approach  are  presented  by  .Juang,  Horta,  and  Robertshaw  21  . 

Classical  proportional-plus-integral-plus-derivative  (PID)  control  has  been  uti¬ 
lized  on  the  Space  Telescope  Pointing  Control  System,  as  presented  by  Dougherty, 
et  al.  22,231.  The  stability  properties  of  such  a  control  scheme  as  applied  to  flexible 
systems  is  discussed  by  Hughes  and  .A.bdel- Rahman  [24i. 

■A.  majority  of  control  techniques  applied  to  vibrating  systems  utilize  regulator  or 
tracking  control  theory.  Basically,  the  controller  is  designed  to  maintain  a  set-point 
or  to  track  a  reference  input.  The  terminal  states  are  not  incorporated  into  the  de¬ 
termination  of  constant  feedback  gains.  The  coupling  between  vibration  regulation 
and  large-angle  slewing  is  discussed  by  Baruh  and  Silverberg  [25] .  The  design  of 
modal  controllers  to  control  several  dominant  modes  of  distributed  flexible  systems 
has  been  suggested  by  Meirovitoh,  et  al.  [26]  and  Balas  ^27).  Other  researchers,  such 
as  Henrichfreise,  Moritz,  and  Siemensmeyer  [28],  have  developed  a  detailed  system 
model  that  includes  the  vibrating  states.  .An  observer  is  constructed  to  estimate 
the  unmeasured  states.  This  technique  works  well  if  the  model  accurately  repre¬ 
sents  the  actual  system.  Stability  problems  can  arise  if  system  parameters  change 
significantly.  Another  approach  has  been  to  utilize  measurements  at  the  tip  of  the 
fle.xible  member  to  generate  control  signals.  Such  an  approach  has  been  used  by 
Cannon  and  Rosenthal  [29i,  Cannon  and  Schmitz  30],  and  Hollars  and  Cannon  31] 
to  actively  control  both  the  rigid-body  angle  and  the  vibration  of  a  flexible  system. 
Stability  problems  again  may  arise,  however,  when  modeling  errors  exist  because 
actuator  and  sensor  are  not  colocated. 

.An  alternative  to  actively  suppressing  the  vibration  is  to  alter  the  damping  char¬ 
acteristics  of  the  structure.  Both  passive  and  active  methods  have  been  proposed. 
.Alberts,  et  al.  [32]  added  layers  of  viscoelastic  matericd  to  a  beam  in  order  to  add 
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passive  damping.  This  reduced  vibration  and  enhanced  stability  in  the  presence 
of  higher  unmodeled  modes.  .Active  damping  techniques  have  also  been  proposed, 
which  add  distributed  damping  to  beam-like  structures.  Silverberg  33]  has  devel¬ 
oped  a  discrete  implementation  which  appro.ximates  uniform  distributed  damping 
with  several  discrete  actuators.  Burke  and  Hubbard  ’.34]  generated  a  distributed 
control  law  by  applying  a  piezoelectric  film  to  the  beam  that  alters  its  resistance  to 
bending  when  given  a  voltage  signal.  .An  extension  of  active  damping  is  presented 
by  Finzi,  Lanz,  and  Mantegazza  [3.5],  who  developed  a  control  law  that  adds  both 
mass  and  damping  at  discrete  locations  to  reduce  residual  vibration. 

.All  of  these  techniques  have  shortcomings  when  applied  to  physical  systems. 
Problems  arise  because  of  unmodeled  modes,  parameter  variations,  and  nonlineari¬ 
ties.  Robustness  of  the  control  methods  in  light  of  these  modeling  errors  is  discussed 
by  .Vesiine  and  Zarchan  36j,  Kosut,  et  al.  [37],  and  Arbel  and  Gupta  [38l.  Balas 
39i  points  out  that  the  presence  of  unmo'deled  modes  can  cause  undesirable  excita¬ 
tion  and  potential  instability.  RadclifFe  and  Mote  [40]  discovered  such  an  instability 
when  they  tried  to  control  the  vibration  of  a  rotating  saw  blade. 

Some  solutions  to  these  problems  have  been  proposed.  Gupta  [41]  and  Gupta,  et 
al.  42;  have  suggested  a  “frequency-shaped  cost  functional”  that  allows  the  feedback 
control  to  be  tailored  to  have  less  energy  at  frequencies  corresponding  to  unmodeled 
system  resonances.  “Innovations  feedthrough”  and  output  feedback  control  have 
been  proposed  by  Balas  [43]  and  Lin,  et  al.  [44]  to  introduce  terms  in  the  control 
lavv  which  can  prevent  instability  due  to  unmodeled  modes.  Sesak,  et  al.  [45]  have 
proposed  a  modified  performance  inde.x  which  suppresses  excitation  of  unmodeled 
modes  in  a  technique  known  as  Model  Error  Sensitivity  Suppression. 

•A  review  of  robust  control  techniques  that  ensure  stability  in  the  presence  of 
parameter  errors  is  given  by  Dorato  [46j.  Yamada  and  Nakagawa  [47]  have  developed 
a  technique  for  designing  a  state  feedback  controller  with  constant  gains  which  works 
over  a  limited  range  of  parameter  variations.  The  effect  of  parameter  uncertainties 


on  a  controller  designed  for  modal  suppression  is  described  by  Calico  and  Moore 

;48i. 

Some  researchers  have  proposed  adaptive  control  metrods  to  compensate  for 
parameter  variations.  Several  different  approaches  have  been  presented  by  Ih  and 
Leondes  491,  Bar-Kana,  et  al.  ,50),  Dubowsky  and  DesForges  olj,  Johnson  52j, 
Benhabib,  et  al.  :53]  and  Potter  and  Ginter  [54]. 

1.3  Overview  of  Thesis: 

The  approach  taken  here,  as  described  in  several  previous  papers  [55,56,57,58,59),  is 
to  generate  smooth  force  profiles  that  have  been  shaped  to  reduce  excitation  energy 
at  the  system  natural  frequencies.  These  profiles  are  constructed  by  summing  har¬ 
monics  of  the  ramped  sinusoid  function  using  an  appropriate  choice  of  coefficients. 
They  result  in  fast  motions  while  minimizing  the  residual  vibration  which  occurs 
at  the  end  of  the  move.  By  minimizing  energy  in  a  band  of  frequency  components 
surrounding  the  nominal  natural  frequency,  some  variation  in  system  parameters 
can  be  tolerated  without  affecting  vibration  attenuation.  A  detailed  development  of 
these  force  profiles  is  given  in  Chapter  2. 

To  put  this  approach  in  perspective,  some  results  using  alternative  filtering  tech¬ 
niques  are  presented  in  Chapter  3.  The  use  of  filters  removes  energy  from  the  input 
at  certain  frequencies  instead  of  building  up  a  function  with  specified  frequency 
content.  These  two  different  approaches  are  compared. 

Since  the  force  inputs  generated  in  Chapter  2  can  only  be  directly  implemented  in 
open-loop  systems.  Chapter  4  discusses  closed-loop  implementations.  In  any  closed- 
loop  system,  the  actual  force  input  is  determined  by  a  combination  of  reference  and 
feedback  signals  and  hence  cannot  be  prespecified.  One  approach  to  incorporate 
these  shaped  inputs  into  closed-loop  systems  is  to  use  a  reference  system  model 
to  generate  the  reference  trajectory.  Results  for  this  approach  are  presented  along 


1. 3:  Overview  of  Thesis: 


14 


with  a  discussion  of  the  problems  that  arise  when  the  reference  model  significantly 
differs  from  the  actual  system  dynamics,  .\nother  iiT>plementation  is  then  developed 
that  generates  an  appropriate  position  reference  by  doubly-integrating  the  shaped 
force  inputs.  Because  this  approach  treats  the  closed-loop  system  as  an  equivalent 
open-loop  system,  these  shaped  inputs  must  be  tuned  to  the  closed-loop  natural 
frequencies.  Finally,  the  optimal  regulator  state  feedback  approach  is  studied  in 
some  detail  to  point  out  several  cases  in  which  it  fails  to  give  adequate  performance. 
When  used  in  conjunction  with  shaped  reference  inputs,  however,  residual  vibration 
can  be  significantly  reduced. 

The  force  profiles  discussed  so  far  assume  that  the  actuators  which  drive  the 
system  can  generate  peak  force  regardless  of  the  velocity.  But  since  the  force  that 
real  actuators  can  provide  decreases  with  speed,  the  system  will  eventually  saturate 
at  some  peak  velocity.  This  has  motivated  the  development  of  velocity  profiles  which 
accelerate  to  peak  velocity,  travel  at  peak  velocity  for  some  time,  and  then  decelerate 
to  final  position.  The  shaped  inputs  developed  in  Chapter  2  do  not  allow  for  any 
motion  at  constant  velocity.  This  limits  system  performance  by  requiring  that  the 
peak  force  be  kept  sufficiently  small.  Thus  in  Chapter  5  a  new  set  of  force  profiles 
are  developed  using  versine  functions  that  allow  motion  at  constant  velocity. 

To  evaluate  the  practical  implementation  of  these  shaped  inputs  in  actual  sys¬ 
tems,  e.xperiments  were  performed  on  the  MIT  Cartesian  Robot.  Chapter  6  discusses 
the  simulation  model  of  the  experimental  hardware  that  helped  determine  appro¬ 
priate  inputs.  Chapter  7  presents  details  of  the  microprocessor  implementation  and 
a  set  of  response  data  indicating  the  usefulness  of  shaped  inputs  in  reducing  system 
vibration.  Chapter  8  presents  a  number  of  conclusions  and  recommendations  for 
future  work. 


Development  of  Shaped  Inputs 


Chapter  2 


2.1  Review  of  Previous  Work: 

In  work  done  for  my  Master's  thesis  [55],  I  developed  input  functions  constructed 
from  a  ramped  sinusoid  and  its  harmonics.  This  function  was  the  solution  to  a 
boundary- value  problem  imposing  zero  magnitude  and  slope  on  the  desired  wave¬ 
form.  Harmonics  are  given  by  characteristic  numbers  that  satisfy  the  boundary 
values.  The  fundamental  ramped  sinusoid  function  alone  requires  nearly  50%  longer 
than  the  time-optimal  input  to  move  a  given  distance  with  a  given  peak  force.  To 
reduce  this  move  time,  harmonics  of  the  ramped  sinusoid  were  added  to  the  funda¬ 
mental.  The  coefficients  of  the  harmonic  terms  were  chosen  so  the  resulting  function 
gives  a  least-squares  fit  to  a  single  cycle  of  a  square  wave.  A  typical  input  function 
consisting  of  five  ramped  sinusoid  terms  is  shown  in  Figure  2.1.  Its  frequency  spec¬ 
trum,  shown  in  Figure  2.2,  has  troughs  at  certain  frequencies.  The  location  of  these 
frequency  troughs  depends  on  the  total  number  of  terms  used  to  construct  the  input 
function.  If  the  system  natural  frequencies  correspond  to  the  trough  frequencies  of 
a  particular  function,  then  that  function  generates  much  smadler  residual  vibration. 
So  the  idea  is  to  pick  the  input  function  with  the  appropriate  number  of  terms. 
Unfortunately,  the  troughs  in  the  input  spectrum  are  very  narrow.  If  the  actual 
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natural  frequency  is  sufficiently  different  from  the  nominal  frequency  for  which  the 
function  was  developed,  a  considerable  amount  of  residual  vibration  may  still  occur. 

For  this  reason,  a  new  method  will  be  developed  for  determining  the  harmonic 
coefficients  of  the  ramped  sinusoid  functions.  Functions  will  be  generated  having  a 
sufficiently  wide  trough  in  the  frequency  spectrum  to  accommodate  errors  in  nominal 
natural  frequencies.  The  hope  is  that  these  functions  will  work  not  only  for  systems 
having  a  static  error  in  natural  frequency  but  also  for  systems  in  which  natural 
frequency  changes  dynamically  with  time. 


2.2  Relationship  Between  Input  Spectrum  and 
Residual  Acceleration  Amplitude: 

Before  actually  formulating  the  desired  input  functions,  it  seems  useful  to  determine 
the  relationship  between  the  input  function  spectrum  and  the  residual  acceleration 
amplitude.  The  work  presented  here  will  restrict  attention  to  a  two-mass  system 
model  (Fig.  2.3)  which  has  one  rigid  body  mode  and  one  resonant  mode.  Mass 
mi  represents  motor  inertia,  mass  m2  represents  endpoint  inertia,  and  k  represents 
transmission  and  structural  stiffness.  This  is  a  good  model  to  represent  the  first 
mode  of  a  single  Cartesian  robot  axis,  in  which  the  endpoint  position  oscillates 
relative  to  the  motor  position  y^  where  the  force  /  is  applied.  Other  axes  can 
be  similarly  represented,  treating  any  cross-coupling  between  axes  as  disturbances. 
Damping  is  neglected  in  this  model  since  it  serves  to  reduce  vibration  amplitudes. 
.A.11  system  parameters  are  treated  in  dimensionless  groups  (Table  2.1),  leading  to 
the  dimensionless  transfer  function  shown  in  Figure  2.3.  All  positions  are  nondi- 
mensionalized  with  respect  to  final  position  (//,  and  T,  represents  the  time  to  move 
the  equivalent  rigid-body  mass  the  same  distance  y/  using  a  square  wave  input  hav¬ 
ing  peak  force  F.  Errors  in  system  natural  frequency  are  represented  by  the  ratio 
where  is  the  actual  natural  frequency  and  is  the  nominal  natural 
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Figure  2.3:  Two-Mass  System  Model. 

frequency. 

For  this  system  model  with  a  single  natural  frequency,  a  direct  relationship  can 
be  derived  between  the  magnitude  of  the  input  spectrum  at  the  natural  frequency 
and  the  amplitude  of  the  residual  acteleration.  The  amplitude  of  the  acceleration 
of  mass  m2  (the  unforced  mass)  after  the  input  force  /  is  turned  off  at  time  Tf  is 
given  by  _ 


where 

=  ^y{Tf)  is  the  acceleration  of  m2  M  time  T/, 

Jo  =  ^y{Tf)  is  the  jerk  of  m2  M  time  T/,  and 

is  the  naturzil  frequency  of  the  two-mass  system. 

Note  that  A  in  expression  (2.1)  represents  the  amplitude  of  free  undamped  vibration. 

In  order  to  determine  expressions  for  and  it  is  necessary  to  use  Fourier 
transforms.  The  general  expressions  for  and  Jo  are  given  by 
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Table  2.1 


Definition  of  Dimensionless  Parameters 


(mi  +  m2)y/ 


Jo  =  —  f  Re{F{'jj)Hj(a;)\  cosuiTj  du; 

T  2-00 


where  F('jj)  is  the  Fourier  transform  of  the  input  function,  Ha{>^)  is  the  Fourier 
integral  representation  of  the  transfer  function  relating  the  input  force  /  to 
and  is  the  Fourier  integral  representation  of  the  transfer  function  relating  / 

and 

-Any  function  /(<)  which  starts  at  time  t  =  0  and  ends  at  time  t  =  Tf  will  have 
a  Fourier  transform  of  the  form 

Fi^)=  =  (2.4) 

Jo 

where  Ffi(uf)  and  F/(u;)  are  the  real  and  imaginary  parts,  respectively.  Deriving 
the  Fourier  integral  representations  of  the  appropriate  transfer  functions  requires 
the  use  of  singularity  functions  as  described  by  Papoulis  [60].  This  leads  to  the 
following  e.xpressions; 


mi  +7712  ~  -2^' 


-[^(u;  -  a;„)  -  6(u;  4-  u;„] 


Hj{uj)  =  - - -  I  -J- - -  -t-  -  —  u;„)  +  S(u7  +  a>„)|| 

mi  +  m2  I  —  u;^  2  I 


iKi' 


I 
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where  S(uj}  is  the  delta  function  defined  by 


/  S(aJ  -  ^o)o{u>)cL}  =  4>(<JJa) 
J  -  -xt 


for  an  arbitrary  function  <d(^'). 


Tsing  these  Fourier  integral  representations  in  the  expressions  for  and  gives 


the  following  results: 


mi  —  m2  L  2  2 


'^n  ^1  "f"  rn,2 


Fni^n)  cos  - F/(u;„)  sin 


Inserting  these  expressions  into  (2.1)  gives 


A  =  - 

mj  -r  m2 


(2.10) 


where 


With  the  following  definition  of  the  dimensionless  frequency  spectrum, 


F-M,)\  = 


iF(^J 


where  F  is  the  peak  force  amplitude  and  T/  is  the  move  time,  the  expression  for 


residual  acceleration  amplitude  can  be  rewritten  in  dimensionless  form  as 


=  T-J—— - r  =-^nr/iF-(u;„T/)!. 

F;(mi  +  m2) 


(2.13) 


These  results  show  that  only  the  frequency  component  corresponding  to  the 
system  resonant  frequency  u!n  contributes  to  residual  acceleration  amplitude.  Of 
course,  the  actual  frequency  spectrum  of  any  given  input  function  also  depends  on 
its  time  duration  Tf.  The  relationship  (2.13)  then  establishes  an  upper  bound  on 
the  input  spectral  magnitude  at  the  system  natural  frequency  in  order  to  achieve 
acceptable  residual  acceleration  amplitude. 


3:  Development  of  Shaped  Functions 


It  is  interesting  to  apply  this  relationship  to  the  bang-bang  function  developed  in 
my  Master’s  thesis  :55).  This  forcing  function  generates  only  peak  force  and  switches 
between  positive  and  negative  force  levels  to  produce  time-optimal  response.  .As  .Ap- 
pendi.x  .A  shows,  this  function  leaves  the  system  with  zero  residual  vibration  only 
because  vibration  excited  in  the  first  half  of  the  move  is  removed  in  the  second  half. 
Thus,  spectral  energy  for  the  entire  function  is  zero  at  the  natural  frequency  and 
(2.13)  is  satisfied.  However,  if  the  actual  system  differs  from  the  nominal  system, 
spectral  energy  at  resonance  will  not  completely  cancel  and  residual  vibration  re¬ 
sults.  Therefore,  we  will  develop  another  input  function  that  tolerates  uncertainty 
in  natural  frequency. 

2.3  Development  of  Shaped  Functions: 

VVe  are  now  in  a  position  to  derive  forcing  functions  that  reduce  residual  vibration 
when  the  system  natural  frequency  is  uncertain.  VV’e  choose  the  ramped  sinusoid 
function  and  its  harmonics  to  construct  a  series  representation  of  the  input,  anal¬ 
ogous  to  a  Fourier  series  representation.  The  coefficients  of  each  harmonic  in  this 
series  will  be  chosen  so  that  the  spectral  magnitude  constraint  is  satisfied.  Ramped 
sinusoid  functions  were  selected  as  basis  functions  because  of  their  odd  symmetry 
about  t  =  T//2  (Fig.  2.4)  and  their  smooth  transitions  in  slope,  which  result  in  the 
narrow  frequency  spectra  of  Figure  2.5. 

In  order  to  allow  for  changes  in  system  parameters,  one  goal  in  picking  coeffi¬ 
cients  in  this  series  will  be  to  reduce  spectral  magnitude  in  a  sufficiently  wide  band 
of  frequencies  surrounding  the  nominal  natural  frequency.  The  system  natural  fre¬ 
quency  is  assumed  to  vary  by  :rlO%.  This  variation  was  chosen  based  on  a  detailed 
dynamic  analysis  of  the  MIT  Cartesian  Robot.  Garcia  Reynoso  .61]  determined  that 
for  two  extreme  locations  of  the  moving  a,xes,  the  maximum  change  in  the  first  three 
natural  frequencies  due  to  the  change  in  geometric  configuration  is  within  ±10%  of 
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the  nominal  natural  frequency.  Thus,  functions  which  ha-  •  ow  spectral  magnitudes 
in  a  band  of  ±10%  surrounding  the  resonant  fr-jquency  would  represent  practical 
inputs  for  such  a  robot  system. 

In  general,  the  input  functions  can  be  represented  by  the  following  series  e.xpan- 
sion,  where  represents  a  particular  harmonic  of  the  ramped  sinusoid  function, 

a(  is  the  characteristic  number  associated  with  each  harmonic  (defined  in  ^55  ),  B(  is 
the  coefficient  for  each  harmonic,  Tf  represents  the  time  to  reach  a  desired  position, 
and  r  is  normalized  time: 

^  B 

f(t)  =  (2.14) 

t=l 

$J(f)  =  1^-  -  rj  -  sinQ;r  — —  cosa^r  (2.15) 

r^t:Tf  (2.16) 

The  goal  is  to  pick  appropriate  values  for  B(  that  will  minimize  move  time  Tf  and 

minimize  spectral  magnitudes  over  a  range  of  frequencies  surrounding  the  system 
natural  frequency 

To  achieve  this,  we  will  combine  these  objectives  into  a  single  minimization  prob¬ 
lem  to  pick  the  coefficients  B(.  To  minimize  move  time,  we  minimize  the  square  of 
the  difference  between  the  ramped  sinusoid  series  and  a  single  cycle  of  a  square 
wave.  This  gives  a  least-squares  fit  to  a  square  wave.  .\  square  v.'ave  is  chosen 
since  it  is  known  to  give  optimal  move  time  for  a  rigid  body.  This  alone  determined 
the  harmonic  coefficients  in  my  Master’s  thesis  55j.  To  explicitly  incorporate  the 
constraint  in  the  frequency  spectrum,  a  second  expression  will  be  added  to  nuni- 
mize  the  squared  magnitude  of  the  frequency  spectrum  F*  at  several  frequencies  a.-, 
surrounding  system  resonance.  .A  weighting  factoi  o  determines  relative  weighting 
between  these  objectives.  The  overall  objective  function  J  represents  the  quantity 
to  be  minimized: 

J  =  —\  1  _  /(^)|-  4-  /  ,  -1  _/(0|'  dfi 

Tf  Jt,I2  ] 


1"  Developw^nt  of  bhaped  Functions 


*/>V(^.r,)-|F*{u;,r/)p 


In  this  formulation,  we  have  arbitrarily  chosen  11  frequencies  surrounding  resonance 
to  satisfy  the  spectral  magnitude  constraint.  This  provides  enough  frequencies  to 
keep  spectral  magnitudes  small  throughout  the  entire  frequency  band  without  the 
need  to  integrate  over  all  frequencies  in  this  band.  The  upper  and  lower  limits 
on  frequency  can  be  adjusted  to  give  any  desired  frequency  band.  For  a  ±10% 
frequency  range,  the  bounds  on  the  frequency  u),  are  0.9u;„  <  u;,-  <  l.la;^. 

The  coefficients  of  the  harmonics  Bf  can  be  calculated  by  differentiating  the 
objective  function  J  with  respect  to  5r,  where  r  represents  a  particular  value  of  the 


inde.K  (,  and  setting  the  result  to  zero. 


dJjdB,  =  0 


(2.18) 


This  gives  an  expression  e.xplicitly  in  terms  of  B(,  and  and  I*,  which  are  known 


functions  of  a.,  and 


p  _  r.  y  .2 _ _ _ 

^  r  t  rt  F  ■  1  si  2  1  'r’\2  1  !  'T'  \‘l 


2  sin  -  ^,Tf  cos 


-  Of  cos  O;  ±  '^(  cos  Q;  -  1  )  j 

-  ^  [t!  ^  (f  -  0 

-  a;,  cos  Or  ^(cos a,  -  1  )j  I  {r  ^  i) 


±  ( ^  -  2  j  sin  a;  +  ^  cos2a^  2a<  cosa< 


(r  =  i) 
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cos  a,  H - sin  Or  -i-  1  . 

•> 


If  the  final  move  time  Tf  is  known,  then  /'^  is  known,  and  the  coefficients  B(  can 
be  determined  by  simply  solving  the  following  set  of  linear  equations,  expressed  in 


matrix  form; 


=  [/;i 


(2.23) 


Unfortunately.  Tf  is  not  known  until  the  coefficients  B(  are  known.  The  dependence 
of  Tf  on  B(  can  be  expressed  in  terms  of  the  square  wave  move  time  T,  and  a  scale 


function  F: 


Tf  =  rT, 


(2.24) 


l 

SF  ^<=1  a, 


'  (2.25) 


r,  =  (2.26.) 

SF  is  a  scale  factor  which  normalizes  the  peak  of  the  function  to  1.  T,  represents  the 
move  time  to  cover  a  distance  yf  when  the  input  is  a  single  cycle  of  a  square  wave 
of  amplitude  F .  F  is  a  function  of  on  and  B(  which  ensures  that  the  resulting 
input  signal  brings  the  system  to  the  desired  final  position.  Since  the  ramped 
sinusoid  functions  cannot  supply  as  much  energy  for  the  same  peak  force  as  the 
corresponding  square  wave,  they  will  take  somewhat  longer  to  complete  the  same 
move.  This  time  penalty  is  represented  by  F.  Due  to  the  inherent  coupling  of  B(  and 
F.  an  iteration  scheme  is  necessary  to  correctly  compute  values  for  the  coefficients 
B/.  This  iteration  procedure  can  be  outlined  as  follows: 

1.  Determine  uj^T,  for  desired  move  distance  and  system  parameters. 

2.  Guess  a  value  of  F.  (Note  that  F  is  slightly  greater  than  1.) 
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3.  Solve  for  Bt  by  solving  the  matrix  equation  (2.23). 


4.  Normalize  ramped  sinusoid  series  e.xpansion  by  determining  the  value  for  the 


scale  factor  SF. 


■5.  Calculate  r  using  e.xpression  (2.2.5). 


6.  Use  the  new  value  of  T  to  update  Bi- 


r.  Repeat  until  T  converges  to  acceptable  accuracy  (error  with  respect  to  previous 


value  is  less  than  10  ’) 


To  improve  convergence,  every  fourth  value  of  F  is  updated  using  Aitken  accelera- 


r..3  = 


r.r.+2  -  ri, 


r.+2  -  2r.^,  +  r, 

Using  the  procedure  putlined  above,  we  can  derive  functions  which  satisfy  our 
objectives.  We  used  a  total  of  £  =  15  terms  for  computational  efficiency  while 
retaining  enough  mathematical  degrees  of  freedom  to  achieve  acceptable  minimiza¬ 
tion.  .A  good  compromise  between  minimizing  move  time  and  minimizing  spectral 
magnitude  near  the  system  natural  frequency  is  achieved  for  a  value  of  p  =  10.  Note 
that  larger  values  of  p  will  give  lower  spectral  magnitudes  and  slightly  higher  move 
times.  Functions  were  developed  which  minimize  the  frequency  content  at  dimen¬ 
sionless  frequencies  u;„r,/2T  of  5,  10,  and  15,  respectively.  Each  of  these  functions 
minimizes  spectral  magnitude  at  11  frequencies  extending  ±10%  around  resonance. 
These  inputs  are  shown  in  Figures  2.6  to  2.8.  The  time  function  is  shown  in  (a)  and 
the  frequency  spectrum  is  shown  in  (b).  Notice  that  the  spectral  magnitudes  for 
the  entire  range  of  frequencies  extending  ±10%  about  '^nT,  have  been  significantly 
attenuated.  In  comparison  with  the  five-term  ramped  sinusoid  function  of  Figures 
2.1  and  2.2,  the  spectral  magnitude  near  the  nominal  natural  frequency  has  been 
attenuated  by  more  than  an  order  of  magnitude  (20  db). 


Ramped  Sinusoid  Input 


Dimeasionless  Frequency 


Frequency  Spectrum  of  Ramped  Sinusoid 


Figure  2.6;  Ramped  Sinusoid  Input  Tuned  tou;„T,/27r  =  5±10%:  (a)  Time  Function 
(b)  Frequency  Spectrum. 


2.3:  Development  of  Shaped  Functions: 
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Figure  2.8:  Ramped  Sinusoid  Input  Tuned  to  u;„r,/27r  =  15  ±  10%:  (a)  Time 
Function  (b)  Frequency  Spectrum. 
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2.4:  Open-Loop  Simulation  Results: 
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Nominal  Response  to  a  Ramped  Sinusoid  Input 

Figure  2.9:  Simulated  Acceleration  Response  for  Nominal  System  With  Ramped 
Sinusoid  Input;^u;Arr,/27r  =  10. 

2.4  Open-Loop  Simulation  Results: 

To  determine  the  effectiveness  of  these  shaped  functions  in  meeting  our  goal,  we 
evaluated  the  response  of  the  two-mass  system  to  these  inputs  using  computer  simu¬ 
lations.  These  simulations  were  performed  using  a  Runge-Kutta-Merson  integration 
routine.  .A,  nominal  value  of  <jj„T,/2ir  =  10  was  assumed  in  order  to  construct  the 
input  function.  This  gives  the  final  dimensionless  move  time  as  u;„T//27r  =  12.  The 
response  of  the  nominal  system  to  this  input  is  shown  in  Figure  2.9  as  the  dimen¬ 
sionless  acceleration  of  mass  m2.  The  acceleration  response  is  shown  rather  than 
the  position  response  because  double  differentiation  accentuates  the  vibration  sig¬ 
nal.  Notice  that  under  nominal  conditions,  residual  acceleration  amplitude  is  nearly 
eliminated  when  the  input  has  finished. 

more  challenging  test,  however,  is  when  the  actual  resonant  frequency  is  dif¬ 
ferent  from  the  nominal  frequency.  If  we  assume  that  the  actual  frequency  is  only 
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Actual  Response  to  a  Ramped  Sinusoid  Input 


Figure  2.10:  Simulated  .\cceleration  Response  for  Actual  System  With  Ramped 
Sinusoid  Input;  =  10,  =  0.9. 


90%  of  the  nominal  frequency  and  use  the  same  input  function  derived  in  the  nom¬ 
inal  case,  the  response  in  Figure  2,10  results.  Notice  that  even  with  a  10%  error  in 
resonant  frequency,  the  input  function  still  achieves  nearly  zero  residual  acceleration 


amplitude. 

These  results  can  be  compared  with  the  square  wave  response  to  determine  the 
effect  of  shaped  inputs  on  residual  vibration.  Square  wave  response  is  shown  in 
Figure  2.11.  The  square  wave  input  generates  considerably  more  residual  vibration 
than  the  ramped  sinusoid  input. 

If  only  move  time  is  compared,  ignoring  settling  time  needed  to  damp  out  residual 
vibration,  the  move  time  ratio  Tf/T,  has  a  value  of  1.2  for  the  ramped  sinusoid 
function.  Thus,  we  can  achieve  the  desired  vibration  attenuation  with  a  move  time 
only  20%  longer  than  that  required  for  a  square  wave.  Since  the  optimal  time  to 
complete  the  move  without  vibration  is  nearly  the  same  as  the  square  wave  time, 
these  functions  only  take  20%  longer  than  time-optimal  inputs.  Because  the  ramped 


2.5:  Shaped  Inputs  for  Several  Natural  Frequencies: 


32 


S  ft-ooio 


1  -*.0010 


I  -4.0020 
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Figure  2.11;  Simulated  Acceleration  Response  for  .\ctual  System  With  Square  Wave 
Input;  a;ivr,/2T  =  10,  =  0.9. 


sinusoid  inputs  nearly  eliminate  residual  vibration,  this  extra  time  is  more  than 
compensated  for  by  the  reduction  in  settling  time. 


2.5  Shaped  Inputs  for  Severed  Natural  Frequen¬ 


cies: 


The  approach  outlined  in  Section  2.3  can  be  extended  to  minimize  excitation  energy 
at  several  natural  frequencies.  The  new  objective  function  can  be  expressed  as 


+  p£(u;.T,)^|F*(u;,T/] 


where  M  is  the  total  number  of  modes  (natural  frequencies)  to  attenuate,  and  w,  is 


given  by 


(1  -  Pjn)^m  <  w;  <  (1  +  p^)uJrn-,  i  =  m,...,llm 


(2.29) 


’■.A' 


2.6:  Sha-ped  Inputs  for  Lightly  Damped  Systems: 
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where  Pn  represents  the  fraction  of  nominal  frequency  that  determines  the  upper 
and  lower  bounds  of  the  frequency  band  surrounding  the  nominal  natural  frequency 

for  the  mth  mode. 

The  remaining  development  follows  e.xactly  as  before.  .A  function  that  attenu¬ 
ates  three  natural  frequencies  was  constructed  in  this  way.  F*"  the  dimensionless 
frequencies  =  1..5,  -5,  and  10,  with  ±10%  frequency  bands,  the  resulting 

shaped  input  function  is  shown  in  Figure  2.12(a),  with  the  corresponding  frequency 
spectrum  shown  in  (b).  Notice  that  all  three  frequency  bands  have  been  attenuated 
as  specified. 


2.6  Shaped  Inputs  for  Lightly  Damped  Systems: 


The  development  so  far  has  assumed  that  the  system  to  be  controlled  has  no  inherent 
damping.  Damping  has  the  effect  of  spreading  out'the  resonant  peak  over  a  broader 
range  of  frequencies.  It  will  therefore  also  affect  the  vibration  attenuation  of  inputs 
that  have  been  shaped  for  an  undamped  system.  The  following  analysis  is  intended 
to  quantify  the  effect  of  damping  on  residual  vibration.  We  will  derive  the  residual 
acceleration  amplitude  for  a  damped  system  in  terms  of  characteristics  of  the  shaped 
input  functions. 

The  model  used  to  derive  this  relationship  is  similar  to  the  undamped  model  of 
Figure  2.3  with  an  additional  viscous  damping  element  6,  as  shown  in  Figure  2.13. 
For  this  system,  the  peak  residual  acceleration  amplitude  of  mass  mi  after  the  input 
force  /  is  turned  off  at  time  Tf  is  given  by 


where 


(2., 30) 


Oo  is  the  acceleration  of  m2  M  lime  Tf, 
Ja  =  is  the  jerk  of  mi  ^  time  TV, 


Magnitude 


f.6;  Shaped  Inputs  for  Lightly  Damped  Systems: 
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Figure  2.12:  Ramped  Sinusoid  Input  Tuned  to  u;„r,/2T  =  1.5,  5,  and  10  i  10%:  (a) 
Time  Function  (b)  Frequency  Spectrum. 


Figure  2.13;  Damped  Two-Mass  System  Model, 
j^n  is  the  undamped  natural  frequency,  given  by 


1^ 

V  mi  V 

m-i  / 

C  is  the  damping  ratio,  given  by 

.  b  /~ 


c  =  -  .  Wi 

2  V  1  V  mo  / 


Using  the  same  technique  as  before,  a,  and  can  be  represented  in  terms  of 
system  parameters  and  input  characteristics  as  follows: 


1 

2k  . 

/ -<jo 

(2.33 

1 

27r  • 

'  -oo 

(2.34 

where  Fi^jj)  is  the  Fourier  transform  of  the  input  function,  Ha{^)  is  the  Fourier 
integral  representation  of  the  transfer  function  relating  f  to  and  Hj(aj)  is  the 


Fourier  integral  representation  of  the  transfer  function  relating  /  and  ^y- 


The  ramped  sinusoid  functions  under  consideration  have  a  Fourier  transform 
which  can  be  written  as 


F(a;) 


(2..35) 
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This  is  a  more  specific  form  of  equation  (2.4)  in  which  Fr(u;)  —  0.  The  Fourier 
integral  representations  of  the  transfer  functions  are  given  by: 

1  +  j2C,LUnuJ 


HA^)  = 


mi  +  m2  (u;2  -  .m-)  -h  j2C^„u; 

I  -r  juilu} 


:2.36) 

(2.37) 


mi  -r  m2  (u;2  -  +  j2Cu;„u; 

After  performing  the  required  residue  calculus  to  obtain  the  integrals,  the  square 
of  the  residual  acceleration  amplitude  can  be  expressed  as 

.4'  = 


Fi(  -u;„  v^l  -  C"  +  jCu^n )FA^n  +  jCu^n  ) .  ( 2.38  ) 


mi  +  m2  ^  1  ~ 

This  gives  residual  amplitude  in  terms  of  the  input  Fourier  transforms  of  complex 
frequencies.  These  can  no  longer  be  expressed  simply  in  terms  of  the  input  frequency 
spectrum  as  was  the  case  for  an  undamped  system  (equation  2.10).  However  they 
can  be  evaluated  for  the  shaped  ramped  sinusoid  function.  In  terms  of  rerd  frequency 
V,  the  function  F[{ui)  can  be  expressed  as 

FTf  1^ 


2  sm  —  ‘M  if  cos  ^7^ 


(2.39) 


where  F  is  the  peak  force  and  SF  is  a  normalizing  scale  factor.  In  order  to  evaluate 
sines  and  cosines  of  complex  arguments,  the  following  identities  are  useful: 

sin( X  ~  ]Y)  =  sin  X  cosh  Y  +  j  cos  X  sinh  Y  ( 2.40 ) 

cos(.Y  ]Y)  =  cos  X  cosh  Y  —  j  sin X  sinh  Y  (2.41 ) 

.After  considerably  more  algebra,  the  final  expression  for  the  dimensionless  squared 
residucd  acceleration  amplitude  is  given  by 
.4  \‘ 


A-?  =  ( 


\  SF  )  1  - 


F/(mi  +  m2) /  ^  SF  /  1  - 

4s*ch'  4c^sh^  -  4a'„  V  I  -  C'^’/sc  —  4(,''^nT'/shch  a;^rj(c^ch^  ^  s*sh^ ! 


L  L 

EE 


BiBrOfar 

\(t>(at)<i>(  ar 

)-4c^(i-c^)u;:it; 

[(P(q^)^  +  4(;^(  1  - 

CXr', 

[o(a.)^^4C^(l-C^)u;iT; 

1 


(2.42) 
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where  s,  c,  sh,  and  ch  are  defined  as 


=  sin.j„Y  1  -  — 


(2.43) 


c  =  cos^^V  ’■  ~  ^  ~ 


sh  =  sinh  C  ^ 
ch  =  cosh  C  ' 


(2.4.5) 


(2.46) 


and  the  functions  ©(a)  are  defined  as 


0(a)  =  -  (1  -  C^)u}lTj. 


(2.47) 


This  expression  (2.42)  gives  the  dimensionless  peak  residual  amplitude  for  a 
particular  ramped  sinusoid  input  as  a  function  of  the  dimensionless  frequency  ujT/. 
This  functiqnal  dependence  can  also  be  expressed  in  terms  of  ujT,  using  the  known 
value  of  r  given  by  expression  (2.25)  for  the  particular  input.  When  (  =  0,  the 
resulting  function  gives  simply  a  scaled  frequency  spectrum  of  the  input,  as  given 
by  (2.13).  There  is  a  direct  relationship  between  residual  amplitude  and  input 
frequency  spectrum  for  an  undamped  system.  For  C  ^  0,  this  functional  dependence 
on  frequency  is  no  longer  proportional  to  the  input  frequency  spectrum. 

For  the  ramped  sinusoid  input  tuned  to  the  undamped  natural  frequency  ^nTf  ;2ir 
10.  constructed  using  the  technique  of  Section  2.3,  we  can  now  investigate  the  effects 
of  system  damping  on  the  residual  response.  Note  that  for  lightly  damped  systems, 
the  resonant  frequency  where  response  amplitude  peaks  is  very  nearly  the  same  as 
the  undamped  natural  frequency.  Figure  2.14  shows  the  frequency  dependence  of 
the  residual  amplitude  for  =  0.  As  expected,  this  looks  similar  to  the  Fourier  spec¬ 
trum  of  Figure  2.7.  When  C  =  0.1,  the  lobes  which  occur  for  C  =  0  disappear  and 


ihe  curve  becomes  smoother,  as  shown  in  Figure  2.15.  For  (  =  0.3  more  smoothing 


takes  place,  as  shown  in  Figure  2.16.  Notice  that  the  peaks  which  appear  in  Figure 
2.14  become  lower  and  the  troughs  become  more  shallow  as  damping  increases  (Fig- 
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Figure  2.16:  Residual  .Acceleration  .Amplitude  as  a  Function  of  for  Ramped 

Sinusoid  Input  Tuned  to  u;„Tj/27r  =  10  ±  10%;  C  =  0.3. 

Ures  2.15  and  2.16).  This  implies  that  slightly  higher  residual  amplitude  will  exist 
for  a  lightly  damped  system  than  for  an  undamped  one.  In  addition,  because  the 
troughs  bow  up  at  their  edges,  the  effective  range  of  frequencies  for  which  residual 
amplitudes  are  small  becomes  narrower. 

Simulation  results  using  this  ramped  sinusoid  input  for  a  lightly  damped  system 
((  =  0.1)  are  shown  in  Figures  2.17  and  2.18.  .Again,  we  plot  the  dimensionless 
acceleration  of  mass  mj.  Figure  2.17  shows  the  case  when  the  dimensionless 
system  undamped  natural  frequency  •jJnTf  coincides  with  the  frequency  for  which 
the  ramped  sinusoid  has  been  tuned.  Figure  2.18  shows  the  case  when  the  system 
undamped  natural  frequency  is  only  90%  of  the  nominal  tuned  frequency.  Notice 
that  for  light  damping,  the  residual  amplitude  is  higher  than  for  the  undamped  case. 
The  effect  of  damping  is  to  raise  the  residual  amplitude  for  frequencies  near  the  limits 
of  the  notch  in  the  frequency  spectrum.  Since  the  natural  frequency  of  the  actual 
system  coincides  with  the  lowest  frequency  which  has  been  filtered  from  the  input 
spectrum,  damped  response  gives  higher  initial  residual  amplitude.  However,  this 
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Figure  2.17:  Simulated  Acceleration  Response  for  Nominal  Damped  System  with 
Ramped  Sinusoid  Ihput;  ijJNTJ2ir  =  10,  C  =  0.1. 


Figure  2.18:  Simulated  Acceleration  Response  for  Actual  Damped  System  with 
Ramped  Sinusoid  Input;  u>ffT,l2w  =  10,  C  =  0.1,  =  0.9. 


2.7:  Closure: 
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amplitude  decays  because  of  the  presence  of  damping.  Therefore,  damped  response 
to  the  ramped  sinusoid  input  for  this  lightly  damped  system  is  satisfactory.  The 
settling  time  for  the  damped  system  response  to  a  square  wave  input  is  considerably 
longer. 

If  the  actual  system  heis  considerable  inherent  damping,  then  an  alternative  is 
to  incorporate  the  more  complex  damped  expression  (2.42)  into  the  minimization 
for  determining  the  harmonic  coefficients.  Because  of  the  complexity  involved  in 
doing  this,  the  simpler  development  assuming  no  damping  is  preferable  since  it  gives 
good  attenuation  over  the  frequency  range  of  interest  for  lightly  damped  systems. 
Since  most  practical  systems  tend  to  be  only  lightly  damped,  the  inputs  developed 
assuming  no  damping  are  appropriate. 


2.7  Closure: 

\ 

This  chapter  has  described  a  method  of  constructing  force  profiles  for  moving  a 
dynamic  system  while  keeping  excitation  energy  near  the  natural  frequencies  as 
small  as  desired.  .4  useful  feature  is  that  the  depth  and  width  of  the  notch  in  the 
frequency  spectrum  can  be  adjusted  to  allow  for  variation  in  the  natural  frequency. 
Force  profiles  can  be  constructed  for  any  number  of  natural  frequencies  occurring 
in  the  physical  system.  As  long  as  system  damping  is  relatively  small,  these  inputs 
generate  motions  with  small  residual  vibration,  even  when  natural  frequencies  are 


uncertain 


Alternative  Filtering  Techniques 


Chapter  3 


3.1  Introduction: 

In  the  previous  chapter,  a  set  of  input  functions  were  developed  to  produce  relatively 

\ 

fast  motions  for  a  vibrating  system.  These  inputs  were  built  up  from  a  ramped 
sinusoid  and  its  harmonics  in,  an  effort  to  increase  the  energy  available  for  motion 
while  minimizing  spectral  energy  near  the  natural  frequency  of  the  system.  An 
alternative  strategy  would  be  to  start  with  a  single  cycle  of  a  square  wave,  which 
IS  known  to  give  time-optimal  response,  and  filter  out  any  spectral  energy  near  the 
natural  frequency. 

Several  methods  for  accomplishing  this  filtering  are  available.  Two  of  these 
techniques  are  discussed  in  the  following  sections  and  evaluated  analytically.  One 
method  is  simply  to  use  an  analog  low-pass  filter  to  pre-shape  the  square  wave  before 
sending  it  on  to  the  vibrating  system.  This  requires  that  the  filter  cut-off  frequency 
be  sufficiently  below  the  lowest  natural  frequency  to  provide  acceptable  attenuation. 

.Another  method  is  to  use  a  notch  filter  to  filter  out  only  those  frequencies  that 
correspond  to  the  system  natural  frequencies.  Such  a  filter  is  hard  to  implement 
in  real  time  since  an  effective  notch  filter  requires  many  poles  which  introduce 
large  phase  lag  at  higher  frequencies.  This  tends  to  delay  the  system  response 
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and  lengthen  the  time  needed  to  complete  the  move.  So  instead  we  will  synthesize 
a  new  time  function  that  will  serve  as  the  notch-filtered  input  to  the  system.  This 
allows  us  to  have  the  entire  input  waveform  available  for  filtering,  including  future 
values  which  would  not  be  available  to  a  filter  in  real  time. 

The  square  wave  input  can  be  filtered  by  removing  frequency  bands  in  its  fre¬ 
quency  spectrum  and  then  regenerating  the  time  function  by  using  the  inverse 
Fourier  transform.  This  approach  gives  time  functions  described  by  sine  integrals. 
These  functions  must  start  earlier  and  end  later  than  the  square  wave  from  which 
they  were  derived  in  order  to  achieve  the  notched  spectrum.  This  leads  to  unac¬ 
ceptably  long  move  times. 


3.2  Analog  Low-Pass  Filter: 


The  simplest  method  to  remove  energy  at  system  natural  frequencies  is  to  pass  the 
square  wave  through  a  low-pass  filter.  This  attenuates  aU  frequencies  above  the  filter 
cut-off  frequency.  The  most  important  consideration  is  achieving  a  steep  roll-off  rate 
at  the  cut-off  frequency  so  that  energy  can  be  passed  for  frequencies  nearly  up  to 
the  lowest  natural  frequency  of  the  system. 

■A.  particularly  useful  filter  to  accomplish  this  is  a  Butterworth  filter,  which  has 
the  desired  low-pass  frequency  response  in  magnitude,  allows  for  any  desired  roll-off 
rate,  and  is  physically  realizable.  A  fourth-order  Butterworth  filter  was  selected  for 
analysis  here. 

The  magnitude  of  the  frequency  response  for  an  nth  order  Butterworth  filter  is 
given  by  (see  Papoulis  [60|,  p.  105) 


(3.1) 


where  is  the  filter  cut-off  frequency  and  n  is  the  order  of  the  filter.  Thus,  for  a 
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Figure  3.3:  System  Response  using  Butterworth  Filtered  Input:  (c)  Acceleration 
Response. 

3.3  Notch-Filtered  Square  Wave: 

Excitation  energy  can  be  introduced  above  the  lowest  natural  frequency  by  notching 
out  only  the  frequencies  in  the  square  wave  frequency  spectrum  that  correspond  to 
system  natural  frequencies.  Such  a  notch  filter  will  be  implemented  by  generating 
new  filtered  time  functions  from  the  square  wave  input.  A  similar  approach  has 
been  presented  by  Singer  [62],  who  also  has  pointed  out  some  of  the  drawbacks. 

For  the  sake  of  clarity,  we  will  again  restrict  attention  to  a  system  model  hav¬ 
ing  only  a  single  natural  frequency,  as  shown  in  Figure  2.13.  Thus,  only  a  single 
frequency  will  be  filtered  from  the  spectrum  of  the  square  wave.  To  generate  the 
filtered  time  function,  we  will  analytically  remove  a  band  of  frequency  components 
from  the  Fourier  spectrum  of  the  square  wave.  We  will  then  produce  a  time  function 
corresponding  to  this  filtered  spectrum  by  taking  the  inverse  Fourier  transform. 
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Frequency  as  multiple  of  cut-off  frequency 

Frequency  Response  of  Butterworth  Filter 


Figure  3.1:  Magnitude  of  Frequency  Response  for  Fourth-order  Butterworth  Filter. 

V 

fourth-order  filter,  the  magnitude  is  given  by 

IfffM!  =  -r=i - ;■  (3.2) 

\  plot  of  this  frequency  response  as  a  function  of  the  parameter  w/wc  is  given 
in  Figure  3.1.  Note  the  steep  fall-off  as  ui/ujc  becomes  greater  than  1.  In  order 
to  attenuate  the  frequency  content  at  the  natural  frequency  by  a  factor  of  100 
(l£rir(u;„)|  =  1/100),  the  ratio  must  be  equal  to  3.16,  as  can  be  verified  by 

the  magnitude  expression  (3.2).  A  Butterworth  filter  with  this  cut-off  frequency 
was  used  to  pre-shape  a  square  wave  before  sending  it  on  to  the  vibrating  system. 
X  block  diagram  representation  of  this  scheme  is  shown  in  Figure  3.2.  The  filter 
transfer  function  Hfia)  and  the  vibrating  system  transfer  function  H{s)  are  given 
in  terms  of  dimensionless  parameters  as  follows: 

_ 1 _ 

3*  +  2.613  (^)%3  +  3.414  +  2.613  (^)  3  +  1 


ffFis)  = 


(3.3) 


Figure  3.2:  Block  Diagram  of  Filtering  Scheme. 


and 


2C5  +  1 


(3.4) 


5^(5^  +  2C5  +  1) ' 

When  we  use  the  filtered  square  wave  as  input  to  this  system,  with  u;„r,/2:r  =  10, 
C  =  0.1,  and  uJnl^c  =  3.16,  we  achieve  the  response  shown  in  Figure  3.3.  Figure 
3.3(a)  shows  the  filtered  input  waveform,  (b)  shows  the  position  response  of  the 
end  mass  m2,  and  (c)  shows  the  acceleration  of  mass  m2,  all  in  dimensionless  units. 
Notice  that  the  system  does  not  settle  down  until  u}„tl2v  is  nearly  16.  Since  the 
time-optimal  response  would  have  finished  in  time  uJnt/'lTC  =  10,  this  filtered  input 
takes  60%  longer  than  the  time-optimal  one.  This  is  also  30%  longer  than  the 
ramped  sinusoid  input  presented  in  Chapter  2,  which  only  takes  20%  longer  than 
the  time-optimal  function. 

Analog  low-pass  filters  work,  but  they  require  considerably  longer  to  complete  the 
move.  In  the  example  above,  the  situation  is  especially  favorable  for  the  filter  since 
the  natural  frequency  is  relatively  high,  permitting  a  reasonably  wide  bandwidth  for 
the  filtered  input.  However,  in  fast  systems  the  parameter  u;„T,/27r  for  the  lowest 
mode  and  for  a  typical  move  is  closer  to  I.  To  avoid  vibration,  the  filtered  signal 
bandwidth  in  these  systems  must  be  reduced  considerably,  which  increases  move 
time  even  more.  The  conclusion  is  that  move  time  can  be  significantly  reduced  if 
some  excitation  energy  is  permitted  in  the  input  function  above  the  lowest  system 
natural  frequency. 
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The  Fourier  transform  of  a  square  wave  of  height  F  and  time  duration  T,  is  given 
by  the  expression: 

rp 

F{uj)  =  —  (l  -  2e-''“^  ^  (3.5) 

luJ  ^  ' 

Since  this  expression  applies  for  both  positive  and  negative  frequencies  u;,  removing 
spectral  energy  at  the  natural  frequency  u;„  requires  notching  both  — and  — 
The  filtered  Fourier  transform  is  given  by 

F'(^)  =  —  (l  -  (1  -  +  -'n)  -  Pa*.(u;  -  u;„))  (3.6) 

]ijj  ^ 

where  -^n)  represents  a  rectangular  pulse  of  height  1  and  width  Au;  centered 

at  u/  =  u:„.  Notice  that  all  frequency  components  in  the  two  frequency  bands  about 
jj  =  ia;„  have  been  removed  by  essentially  subtracting  the  original  spectrum  in  the 
two  regions  specified  by  the  pulses. 

The  inverse  Fourier  transform  of  the  sum  of  these  two  rectangular  pulses  is  given 
by 

1  2  sin  ^u)t 

/ptO  =  T-  /  +  Wn) -^n)]  =  - - - cosuj.  (3.7) 

JTT  J  —oo  “Kt 

The  filtered  time  function  can  be  completely  represented  in  terms  of  the  unit  step 

function  u{t)  and  its  time  convolutions  (represented  by  the  symbol  «')  with  the 

sinusoidal  function  fp{t)  of  equation  (3.7): 

f'[t)  =  F  [(x(0  -  2n(f  -  T,/2)  +  -  T,)] 

-  F  [/p(0  *  u(f)  -  2fp(t  -  TJ2)  *  u{t  -  T,/2)  +  fp[t  -  T,)  ^  u{t  -  T,)\  (3.8) 


These  time  convolutions  can  be  evaluated  as 

1  /•("’> +  sin  r 


fp{t)  *  u{t)  =  -  j 

T  ./{w 


dr. 


(.3.9) 


The  integral  on  the  right-hand-side  is  known  as  the  sine  integral,  which  is  a  tabulated 
function.  Thus,  the  above  expression  can  be  rewritten  as 


1 


fp{t)  *u(t)  =  -  [si  ((u;„  -I-  Au;)<)  -  si  ((u;„  -  Au;)<)) 

TT 


(3.10) 
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imensioiiless  Time 


Notcli>Filtered  Square  Wave 


Figure  3.4:  .Notch-Filtered  Square  Wave  Time  Function. 


where  the  sine  integral  si  is  defined  by 


>  /■'*  sin  r  ,  TT  /■*  sin  r  , 

}i(t)  =  -  /  - dr  =  - dr. 

Jt  r  2  Jo  T 


(3.11) 


Using  these  sine  integral  expressions,  the  time  function  f'(t)  can  be  rewritten  in 
terms  of  dimensionless  parameters  as 


f'iu^t)  =  F[uM)-2uMt-Tj2))  +  uMt-T,))] 

-F  —  Isi ((u;„ -I- Au;)f )  -  si ((u;„  -  Au;)f)] 

.TT 

--  [si  ((u;„  -  Au;)(<  -  r,/2))  -  si  ((u;„  -  Au;)(<  -  T,/2))]  (3.12) 

TT 

4--  [si((u;„  -i-  Au;)(i  -  T,))  -  si((wn  -  Au;)(t  -  T,))]  . 

TT 

A  plot  of  this  filtered  square  wave  input  computed  as  a  function  of  time  is  shown  in 
Figure  3.4,  for  values  of  u;„7’,/2x  =  10  and  Aa;/u;„  =  0.1  (a  ±10%  frequency  band). 

To  strictly  maintjun  zero  magnitude  in  the  filtered  frequency  spectrum  requires 
that  the  input  start  before  t  =  0  and  end  after  t  =  T,.  This  can  readily  be  seen 
in  Figure  3.4.  In  fact,  the  input  function  would  need  to  occur  for  all  time.  If  this 
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input  function  is  truncated  by  a  window  of  half- width  Tt  centered  at  <  =  T,/2, 
then  the  input  is  active  in  the  range  T,/2  -  Tt  <  t  <  T,/2  T.  Truncation  of 
the  time  function  will  give  a  nonzero  frequency  spectrum  in  the  specified  frequency 
band.  The  Fourier  transform  of  this  truncated  time  function  gives  the  dimensionless 
frequency  spectrum  as 

(3.13) 

When  this  integral  is  evaluated,  the  following  expression  results: 

/^•(-^r,)i  =  4ri2(cos^-l) 

I  2 

L  T'  '  I 

- cos  — ^Fi(u;r,) -i- sin -;^F2(u;T5)  -  2/’3(u:T,)  -  2 cosSiwTjF),  |  (3.14) 

TT  L  —  —  J  1 

where  Fj,  Ft,  and  F3  are  functions  of  .jjT,  and  F4  is  a  constant.  To  simplify  the 

representation  of  these  functions,  we  define  the  following  frequencies  and  coefficients: 


I  I  fT,i2*Tt 

F*(^rj|  \ 

FT,  |2t./2-t, 


u>iT  =  (1  +  Au;/u;„)(u;„Tt  +  u;„r,/2) 

(3.15) 

UI2T  =  (1  —  Au;/u;„)(u;„Tt  -1-  u;„r,/2) 

(3.16) 

>j;jT  =  ( 1  -f  Au;/ .jj„){uJnTt  —  aj,iT,/2) 

(3.17) 

ui^T  =  (1  -  dkuj i\iJn)(>jJnTt  -  u;„r,/2) 

(3.18) 

ijJsT  =  (!-*-  Auj  1  IMn)<J^nTt 

(3.19) 

(MqT  =  (1  -  Au;/u;„)u;„Tf 

3  ^nT't 

id\  —  rj, 

^rxJ, 

(3.20) 

(3.21) 

*  =  (■‘^>  *  5) 

(3.22) 

A  =  (  j,  -  1) 

(3.23) 

Using  these  parameters,  the  functions  Fi  through  F4  can  be  written  in  terms  of  the 

sine  integral  si,  defined  by  (3.11),  and  the  cosine  integral  ci,  defined  by 

,  ,  cos  r  ,  .  F  cos  r  —  1  , 

ci(t)  =  -  - dr  =  In  lU  +  /  - dr.  (3.24) 

Jt  T  Jo  T 
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The  functions  can  then  be  expressed  as  follows: 

Fi[u}T,)  =  —  silu^iT  +  32ljT,)  -i-  silui^T  4-  S-i'jjT,) 

—  Si.(^.jJ\T  -r  3iujT,)  +  Slfu^lT'  —  32^T,)  —  5i[uJ2T  —  32^T,)  (3.25) 
-*-si(a;3T  -  )  -  si(u,’4r  — 

Fi(^F,^  =  — ci(u;i7’  i- )  4- ci( lJ2 T  4- "i"  3ju)T,) 

~ci{u)^T  T  3i'j‘jT,)  +  cifu^iT  —  j32'-‘^T,)  —  ci{uJ2T  —  32ujT,)  (3.26) 
-ciiuj^T  -  dz'^T,)  4-  ci(u;4T  -  d^uiT,) 

If  u/nTt  =  uinTJl,  then 

isi^Tj)  =  — ci(tJiT  -f  32<jjT,)  -f-  ci(u;2T  4-  32'jjT,)  ci(u;iT  —  32ujT,) 

— ci(u;2T  —  ~  In  1u;2T  4-  32'jjT,\  ■*•  In  |a>xT'  4*  /i2'^T,l  (3.27) 

-  In  joJiT  -  32^T,  \  4-  In  iu;2T  —  32‘->tT,\ 


F^i^T,)  =  s\((jJzT  +  3^(jjT,)  —  si(u;6T  4-  ^itu^T,)  4-  si(u;5T  —  jSiujT,) 

—  —  3i.mT,)  (3.28) 

Fi  =  si(u.-ir)  -  si(u;2r)  -  si(u;3r)  -  si(u;4T’)  -  2si(u;5r)  +  2si(w6r)  (3.29) 

A  plot  of  this  frequency  spectrum,  with  values  of  u;„r,/27r  =  10,  Au;/u;„  =  0.1, 
and  uJnTt!2Tr  =  5  is  shown  in  Figure  3.5(a).  In  this  case,  the  input  function  has 
been  truncated  so  that  only  the  portion  for  0  <  i  <  T,  remains.  The  frequency 
spectrum  shows  considerable  spectral  magnitude  at  the  dimensionless  frequency 
u;„r,/  27r  =  10,  where  the  input  should  have  been  filtered.  The  considerable  energy 
which  this  input  function  contains  at  the  natural  frequency  is  a  direct  result  of  the 
truncation  in  time. 


If  a  longer  portion  of  the  input  function  is  used,  then  the  spectral  magnitude 
near  the  natural  frequency  will  decrease.  This  is  illustrated  in  Figure  3.5(b)  and  (c). 
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Figure  3.5:  Frequency  Spectra  of  Truncated  Notch-Filtered  Square  Wave:  (c) 


^nTtl'lir  =  50. 


In  Figure  3.5(b),  the  input  is  truncated  with  a  window  of  half-width  ^„Tt/'27r  —  15. 
This  corresponds  to  the  function  a.s  shown  in  its  entirety  in  Figure  3.4.  In  figure 
3.5(c),  the  truncation  window  has  half-width  =  50.  This  corresponds  to  an 

input  which  lasts  for  a  total  dimensionless  time  of  100  multiples  of  27r.  This  is  an 
order  of  magnitude  longer  to  cover  the  same  distance  than  the  original  square  wave. 
Yet  the  spectral  magnitude  near  resonance  is  still  more  than  an  order  of  magnitude 
larger  than  that  of  the  corresponding  ramped  sinusoid  function  shown  in  Figure  2.7. 
which  only  takes  25%  longer  than  the  square  wave  input. 


In  summary,  the  time  function  produced  by  completely  removing  the  frequency 


components  in  a  notch  near  resonance  has  infinite  duration.  When  this  input  is 
truncated  in  time,  considerable  energy  still  remains  near  resonance.  As  spectral 
energy  is  reduced,  the  input  function  takes  longer  to  complete.  To  achieve  sufficient 
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filtering  at  resonance,  so  much  of  the  input  must  be  retained  that  the  move  takes 
much  longer  than  necessary.  The  ramped  sinusoid  functions,  in  contrast,  have  lower 


spectral  magnitude  at  resonance  with  a  much  smaller  time  penalty. 


Before  closing  this  chapter,  it  is  worthwhile  to  comment  on  the  use  of  continuous 


Fourier  transforms  in  the  development  of  the  preceding  functions.  It  would  have  been 
easier  to  take  discrete  Fourier  transforms  (FFT’s).  However,  the  resolution  of  these 


Fourier  transforms  is  limited  by  the  duration  of  the  time  function.  With  a  square 


wave  input  of  duration  t  =  T,,  the  discrete  frequency  components  in  the  FFT  occur 


only  at  multiples  of  'Ix/T,.  Everywhere  in  between,  the  FFT  claims  to  be  zero  when 


in  fact  the  continuous  Fourier  transform  has  discernible  amplitude.  This  is  a  result 


of  the  fact  that  the  FFT  assumes  that  the  input  function  is  periodic  with  period 


T,  when  in  reality  it  only  occurs  for  time  0  <  t  <  T,.  Should  the  actual  natural 


frequency  lie  between  these  discrete  frequency  points,  even  zeroing  out  the  adjacent 
components  will  not  zero  the  frequency  component  at  the  actual  frequency  in  the 
continuous  Fourier  transform  of  the  filtered  input.  Increased  frequency  resolution 
can  be  obtained  by  adding  zeros  to  the  time  function  from  t  =  T,  to  t  =  Tmax  >  T,, 
thus  giving  frequency  components  at  multiples  of  'IziTmax-  However,  this  does  not 


alter  the  original  problem.  Therefore,  even  though  the  computation  of  continuous 


Fourier  transforms  is  more  complex,  it  ensures  that  all  frequency  components  are  at 


least  ideally  reduced  to  zero. 


3.4  Closure; 


We  have  presented  two  alternative  filtering  techniques  in  this  chapter  to  put  the 


work  of  Chapter  2  into  perspective.  Instead  of  constructing  a  function  to  look  like 


a  square  wave  while  maintaining  some  specified  bounds  in  the  frequency  spectrum. 


we  tried  here  to  filter  out  the  specified  frequency  components  of  a  square  wave.  .A. 
simple  low-pass  filter  can  be  used  to  remove  all  frequency  components  of  the  input 


i 
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above  the  filter  cut-off  frequency,  which  is  chosen  to  be  somewhat  less  than  the 
lowest  system  natural  frequency.  .\  fourth-order  Butterworth  filter  works  quite  well 
in  reducing  residual  vibration,  but  response  time  is  relatively  long  because  no  input 
energy  is  passed  above  the  lowest  natural  frequency  of  the  vibrating  system. 

Another  alternative  is  to  generate  time  functions  from  a  square  wave  spectrum 
that  has  had  all  frequency  components  removed  in  a  band  surrounding  the  natural 
frequency.  This  produces  alternative  time  functions  to  those  specified  by  the  ramped 
sinusoid  series,  which  are  given  in  terms  of  sine  integrals.  These  functions  must  start 
considerably  earlier  and  end  considerably  later  than  the  corresponding  square  wave 
in  order  to  achieve  sufficient  filtering.  Thus,  move  time  is  unacceptably  long. 

Therefore,  although  these  filtering  techniques  present  viable  alternatives,  both 
the  low-pass  filter  and  the  notch  filter  lead  to  considerably  longer  move  time.  The 
ramped  sinusoid  functions,  however,  permit  a  simpler  implementation  of  filtered 
inputs  without  excessively  increasing  move  time. 


Closed-Loop  Implementation  of 
Shaped  Inputs 


Chapter  4 


4.1  Introduction: 


The  shaped  inputs  developed  in  Chapter  2  are  given  strictly  as  functions  of  time. 
This  means  that  they  can  only  directly  be  used  in  systems  where  the  force  can  be 
specified  as  a  function  of  time.  Since  closed-loop  systems  with  feedback  determine 
control  force  as  a  function  of  system  states  rather  than  as  a  function  of  time,  these 
shaped  inputs  can  be  specified  directly  only  in  open-loop  systems.  Because  most 
physical  systems  experience  disturbances,  nonlinearities,  and  parameter  uncertainty, 
accurate  performance  cannot  be  guaranteed  for  open-loop  control.  Thus,  we  need 
some  way  of  incorporating  these  shaped  inputs  into  a  closed-loop  control  system. 

In  this  chapter,  we  will  present  several  methods  for  incorporating  shaped  inputs 
into  closed-loop  systems.  The  first  scheme  directly  sends  the  shaped  force  into  the 
vibrating  system.  This  represents  the  feedforward  portion  of  the  control  force.  This 
same  input  also  goes  into  a  reference  model  of  the  vibrating  system  to  generate  an 
ideal  response.  This  response  is  compared  with  feedback  states  and  the  error  is  used 
as  an  additional  control  input  to  help  generate  the  desired  ideal  response  even  when 
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the  actual  system  differs  from  the  ideal  system. 

Some  of  the  drawbacks  of  this  method  are  then  discussed,  keeping  in  mind  the 
limitations  which  actual  systems  impose  on  the  controller.  These  observations  serve 
to  motivate  a  different  closed-loop  implementation.  In  this  new  formulation,  only 
motor  states  are  measured  and  a  simple  PD  loop  is  used  to  achieve  accurate  positions 
in  the  presence  of  disturbances.  The  shaped  force  input  is  converted  into  an  equiv¬ 
alent  position  reference  trajectory  and  the  motor  feedback  allows  the  closed-loop 
system  to  follow  this  time-varying  reference  signal. 

Once  an  appropriate  closed-loop  implementation  has  been  developed,  we  look 
more  carefully  at  the  optimal  regulator  formulation  and  indicate  several  cases  in 
which  it  fails  to  give  adequate  performance.  Shaped  reference  inputs  then  serve  to 
augment  the  optimal  regulator  and  minimize  residual  vibration. 


4.2  Model-Reference-Based  Control  Scheme: 


4.2.1  Overview  of  Concept: 


The  first  closed-loop  implementation  to  be  studied  involves  the  use  of  a  reference 
system  model.  This  control  scheme  is  not  to  be  confused  with  Model  Reference 
.\daptive  Control.  State  feedback  is  used  to  impose  on  the  actual  system  the  ideal 
behavior  of  the  reference  system.  The  shaped  force  input  is  directly  applied  to  both 
systems.  The  error  between  the  actual  response  and  the  ideal  model  response  serves 
to  correct  the  control  input  to  maintain  the  desired  response. 

A  key  feature  of  this  control  implementation  is  the  use  of  the  shaped  force  as  a 
direct  feedforward  input  to  the  controlled  system.  The  control  input  is  thus  specified 
as  a  function  of  time  as  well  as  a  function  of  the  error  states.  The  main  advantage  of 
introducing  a  feedforward  signal  is  the  ability  to  deal  with  unwanted  resonant  vibra¬ 
tions  before  they  occur  by  proper  frequency-shaping  of  the  feedforward  functions. 
An  outline  of  this  approach  was  presented  in  an  earlier  paper  [63j. 
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Figure  4.1;  Block  Diagram  of  Model- Reference- Based  Control  Scheme. 

The  use  of  additional  feedforward  signals  to  reduce  system  tracking  error  is 
quite  common.  Dougherty,  et  al.  [22]  suggest  the  use  of  acceleration  feedforward 
in  the  pointing  control  of  the  Space  Telescope.  .4  similar  technique  has  been  used 
to  compute  joint  torques  of  serial-link  robot  arms.  The  acceleration  of  the  refer¬ 
ence  trajectory  is  used  to  reduce  tracking  errors,  as  described  by  An,  .Atkeson,  and 
HoUerbach  [64] .  In  each  case,  a  feedforward  signal  derived  from  the  reference  is 
directly  fed  to  the  system  to  reduce  tracking  error.  However,  no  frequency-shaping 
is  done  on  the  feedforward  functions  to  reduce  vibration. 

4.2.2  Controller  Specifications: 

.4  block  diagram  of  the  proposal  control  scheme  is  shown  in  Figure  4.1.  Since 
in  typical  systems  the  motor  position  is  usually  meeisured  instead  of  the  absolute 
endpoint  position,  we  will  do  likewise  here.  Thus,  an  additional  transfer  function 
H^{s)  is  necessary  to  obtain  the  endpoint  position  y *  ^ls  a  function  of  motor  position 
y^.  The  coiripensator  G(s)  represents  the  combination  of  a  state  feedback  control 
law  and  a  state  estimator.  State  feedback  ensures  that  all  the  actual  system  states 
approach  the  ideal  reference  states.  Since  only  motor  position  is  measured,  the  I 

remaining  states  are  estimated  using  a  steady-state  Kalman  filter.  j 

To  evaluate  this  control  scheme,  very  simple  models  were  used  to  represent  the 
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Figure  4.2:  Damped  Two- Mass  System  Model, 
Table  4.1 

Definition  of  Dimensionless  Parameters 


ideal  plant  and  the  actual  plant.  simple  damped  two  mass,  one  spring  model, 
shown  in  Fig  4  ’  represents  a  system  with  one  resonant  mode  and  one  rigid  body 
mode.  The  control  force  u  acts  on  mass  mi,  while  a  disturbance  force  w  acts  on 
m2,  the  mais&.we  wish  to  control.  For  the  sake  of  generality,  all  parameters  have 
been  nondimensionaiized,  as  shown  in  Table  4.1,  where  t/^  is  the  final  position  of 
the  controlled  mass,  v  is  the  measurement  noise,  and  is  the  nominal  undamped 
natural  frequency,  given  by 


(4.1) 


n  m  - 
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and  C  is  the  damping  ratio,  given  by 

6  rr 


The  ideal  plant  is  assumed  to  vibrate  at  the  nominal  natural  frequency  u;,v  and 
to  have  no  disturbance  force  acting  on  it.  Its  transfer  function  relating  the  control 
input  u’  to  the  motor  position  is  given  by: 


!^’(s)  (1  +  +  2(5  +  1 

LJ  (  \  _  V  '  _  ^  mi  ' 

~  u-{s)  ~  52(52^.2(5  +  1) 


(4.3) 


This  ideal  plant  is  used  to  generate  the  motor  position  reference  y'  for  the  feedback 
loop. 

The  actual  plant  is  assumed  to  vibrate  at  a  natural  frequency  denoted  by 
which  may  be  different  from  the  nominal  frequency  u;.v  It  also  has  a  disturbance 
force  w’  acting  on  mass  m2.  Therefore,  it  has  two  transfer  functions  associated  with 
the  measurement  y^: 


Ha(s)  = 


\  / 

2, 


“■(>>  2C  (5J)  ^  +  (SJ)  I 

ii;(s)  ^  +  (S^) 

+  (-)’] 

In  addition,  the  endpoint  position  is  given  in  terms  of  the  motor  position  by 

</;(»)  +  _ 


(4.4) 


(4.5 ) 


HAs)  = 


2  • 


(4.6) 


This  plant  represents  the  idealized  model  of  the  actual  system  and  is  used  to  derive 
the  optimal  feedback  compensator  for  ojaI'jJn  =  1-  If  could  also  have  included 
additional  nonideal  characteristics,  such  as  nonlinearities  and  unmodeled  modes, 
but  for  simplicity  these  were  neglected  in  this  analysis. 

The  state-space  formulation  of  the  actual  plant  model  is  given  by: 

X  =  Tx  -f  6u’  ~fw* 


(4.7 


=  c^x  +  w* 


where  x  is  the  state  vector  consisting  of  endpoint  position  j/*  and  its  three  derivatives, 
A  is  the  dynamics  matrix,  b  is  the  control  input  vector,  7  is  the  disturbance  input 
vector,  w"  is  the  dimensionless  disturbance  force  acting  on  m2,  c  is  the  output 
vector,  r*  is  the  noisy  measurement  of  y*,  and  y*  is  the  nondimensionalized  noise 
that  corrupts  the  measurement  of  y^. 

The  feedback  compensator  shown  in  Fig.  4.1  represents  the  transfer  function 
equivalent  of  an  optimal  state  feedback  controller  and  a  steady-state  Kalman  filter 
applied  to  the  plant  model  given  by  Equation  (4.7).  This  approach  was  motivated  by 
an  article  by  Bryson  [6.5]  that  discusses  a  classical  interpretation  of  optimal  control 
theory.  Basiczdly,  quadratic  performance  index  weightings  are  adjusted  to  achieve 
desirable  filtering  properties  in  the  compensator.  The  plant  model  used  to  construct 
the  compensator  was  assumed  to  have  =  1,  mijm2  =  1,  and  {  =  0.1. 

In  conventional  Kalman  filter  design,  white  noise  processes  are  assumed  for  w* 
and  y*.  In  designing  this  compensator,  the  spectral  densities  for  w*  and  v*  were 
treated  as  parameters  that  were  selected  to  achieve  good  filtering  of  the  endpoint 
position  measurement  at  higher  frequencies.  Thus,  the  Kalman  filter  accommodates 
disturbances  and  measurement  noise  as  well  as  estimating  unmeasured  system  states. 

The  feedback  compensator  was  designed  in  two  parts,  as  suggested  by  the  sepa¬ 
ration  principle.  In  this  development,  u*  is  assumed  to  consist  only  of  the  feedback 
component,  i.e.  no  feedforward  function  is  applied.  The  state  feedback  gains  were 
determined  by  minimizing  the  following  quadratic  performance  index: 

The  value  of  p  was  selected  to  be  1/49  so  as  to  weight  the  penalty  on  endpoint 
position  error  more  heavily  than  control  input.  This  leads  to  a  set  of  constant 
feedback  gains  on  the  system  states. 

The  steady-state  Kalman  filter  gains  were  determined  so  as  to  minimize  the 
e.xpected  value  of 
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Figure  4.3:  Magnitude  of  Frequency  Response  of  Optimal  Compensator. 

given  the  spectral  densities  q  and  r  for  w*  and  »*,  respectively.  In  analogy  with  the 
optimal  regulator  problem,  this  minimum  variance  observer  leads  to  a  steady-state 
Riccati  equation  which  depends  on  the  ratio  r/q.  A  value  of  1  was  used  here  for 
r/q  to  give  a  compensator  capable  of  accommodating  both  plant  disturbances  and 
measurement  noise. 

The  final  compensator  transfer  function  for  these  weightings  is  given  by: 

,  u*(5)  22(sr0.27)(s2  + 0.12^ +  1.5)  ,,,,, 


(s2  -  0.94s +  1.3)(s2  + 6.6s +  22)  ''  ' 

This  transfer  function  can  be  represented  in  a  frequency  response  plot.  Such  a 
depiction  emphasizes  the  filtering  properties  of  the  compensator,  which  depend  on 
the  number  of  controlled  states,  a  fact  pointed  out  by  Larson  and  Likins  [661.  A 
plot  of  the  magnitude  of  the  frequency  response  for  our  compensator  is  shown  in 
Fig.  4.3.  Here  the  frequency  is  normalized  to  the  resonant  frequency  of  the  system. 
.Vear  resonance,  the  compensator  acts  as  a  notch  filter.  Beyond  resonance,  higher 
frequency  components  are  at  first  amplified  by  the  full  state  feedback  controller, 


^  ^jnu" h  iivt  wwr 
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This  compensator  has  a  pair  of  poles  in  the  right-half-plane.  These  poles  will 
not  appear  in  the  closed-loop  transfer  function,  but  they  could  appear  as  closed-loop 
zeros  if  a  different  compensator  is  used  in  the  feedforward  path.  This  can  potentially 
lead  to  poor  transient  response. 

If  the  original  plant  for  which  the  compensator  is  developed  is  more  lightly 
damped  than  C  =  0.1,  then  the  characteristics  of  the  compensator  change.  If  the 
open-loop  damping  ratio  is  assumed  to  be  C  =  0.02,  the  compensator  for  the  same 
weightings  as  before  has  the  transfer  function  given  by 


G(^)  = 


u*(s)  22(s -h  0.25)(s^  -  0.025s  4- 1.3) 


(4.11) 


y;,(s)  (s^  -  0.89s  +  1.6)(s^  +  6.6s  +  22) ' 

Notice  that  this  compensator  has  a  pair  of  zeros  in  the  right-half-plane  in  addition 
to  a  pair  of  poles.  This  is  common  in  optimal  controllers  for  systems  with  lightly 
damped  poles,  as  pointed  out  by  Martin  and  Bryson  [67].  In  the  feedback  loop, 
this  is  of  no  concern.  However,  if  this  same  compensator  is  used  in  a  tracking 
controller  to  act  on  the  reference  signal,  then  the  nonminimum  phase  zeros  occur  in 
the  closed-loop  system  and  can  cause  poor  transient  performance.  This  is  a  result 
of  the  fact  that  this  compensator  was  derived  for  a  regulator  control.  Typically, 
a  new  compensator  would  be  derived  for  a  tracking  controller  that  would  have  no 
right-half-plane  zeros. 

The  closed-loop  transfer  function  between  yf  and  y^  for  C  =  0.1  is  given  by 

y;(5)  44(s  +  0.27){s2  ^  0.1s  +  O.Slfs^  +  0.12s  +  1.5) 

y;(s)  “  (s2  +  1.4s  +  0.69)(s^  +  0.56s  +  1.4){s2  +  2.7s  +  2.3)(s^  ^  1.2s  ^  3.1) 

(4.12) 

The  right-half-plane  poles  of  the  compensator  do  not  appear  as  right-half-plane  ze¬ 
ros  because  the  same  compensator  is  used  in  the  feedforward  path.  The  dominant 
closed-loop  poles  (with  the  lowest  natural  frequencies)  have  damping  ratios  of  0.84 
and  0.24.  Thus,  the  optimal  regulator  has  replaced  the  lightly-damped  open-loop 
poles  with  more  heavily  damped  closed-loop  poles.  The  dominant  closed-loop  damp¬ 
ing  ratio  achievable  with  an  optimal  regulator  depends  on  the  control  weight  p,  as 
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Figure  4.4:  Closed-Loop  Damping  Ratios  as  a  Function  of  Control  Weight  for  Several 


Open-Loop  Damping  Ratios. 


shown  in  Figure  4.4  for  several  open-loop  damping  ratios.  .\s  control  weight  de¬ 
creases,  the  damping  ratio  of  the  dominant  closed-loop  poles  increases.  Systems 
having  higher  inherent  open-loop  damping  can  achieve  larger  closed-loop  damping. 
But  even  with  an  optimal  controller,  the  maximum  achievable  closed-loop  damping 


ratio  is  limited. 


4.2.3  Closed-Loop  Simulation  Results: 


The  control  scheme  suggested  in  Fig.  4.1  was  used  to  determine  closed-loop  re¬ 
sponses  using  the  shaped  functions  of  Chapter  2  as  the  feedforward  inputs  uj.  A 
dimensionless  time  was  used  to  specify  move  time  relative  to  the  resonant 

period.  The  time  T,  represents  the  time  to  move  the  center  of  mass  of  the  two-mass 
system  a  distance  y/  when  driven  by  an  input  force  which  is  for  the  first  half  of 
the  move  and  -F  for  the  second  half.  Therefore,  u;,vr,  is  given  by: 


^  rn2)yfl F 


(4.13) 
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The  actual  dimensiouless  move  time  is  somewhat  longer  than  u^.vT,  since  the  shaped 
forcing  functions  do  not  provide  as  much  energy  for  a  given  peak  force  F. 

For  this  series  of  simulations,  a  value  of  10  was  used  for  the  parameter 
damping  ratio  was  assumed  to  be  0.1,  and  mass  ratio  rni/m,  was  taken  to  be  1. 
Three  sets  of  simulations  were  performed.  In  the  first,  the  actual  plant  was  taken 
to  be  identical  to  the  ideal  model,  with  ,^,’4,  .4,'v  =  1.  The  control  system  generates 
the  required  control  input  to  produce  the  output  that  is  called  for  by  the  forcing 
function.  Of  course,  when  the  controlled  system  is  ideal,  as  we  assume  here,  the 
output  e.Kactly  follows  the  reference  input  and  no  feedback  correction  is  generated. 
However,  the  feedforward  function  applied  here  leads  to  some  residual  vibration  even 
in  the  ideal  system.  Therefore,  the  reference  input  imposed  on  the  feedback  loop  was 
set  to  yi  after  the  feedforward  function  ended  in  order  to  bring  the  system  to  rest. 
This  response  is  shown  in  Figure  4.5,  with  total  control  input  in  (a)  and  acceleration 
response  (y*)  of  in  (b).  Notice  that  the  feedforward  function  alone  brings  the 
system  to  final  position  with  very  little  vibration  for  the  feedback  loop  to  damp  out. 
This  gives  negligible  settling  time  with  residual  vibration  nearly  eliminated  beyond 

-  1.3. 

In  the  second  simulation,  the  actual  system  was  assumed  to  have  a  natural 
frequency  different  from  the  nominal  frequency,  with  ~  0.9.  The  response 

under  these  conditions  is  shown  in  Figure  4.6.  In  this  case,  residual  vibration  takes 
until  =  14  before  it  settles.  This  is  longer  than  the  nominal  system  response 

of  Figure  4.5  because  the  initial  residual  amplitude  is  higher  for  damped  systems 
with  an  errorTn  natural  frequency. 

When  a  disturbance  is  added  to  the  model  for  the  actual  system  with  uj —  L. 
the  advantages  of  combining  feedforward  and  feedback  control  become  apparent. 
Figure  4.7  shows  the  response  when  a  constant  opposing  disturbance  force  acts  on 
the  end  mass.  X  force  of  dimensionless  amplitude  0.0003  was  used.  This  represents 
a  disturbance  having  30%  of  the  peak  force  level  of  the  input  functions.  Notice  that 
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Nominal  Closed-Loop  Response  to  a  Ramped  Sinusoid  Input 


(a) 


Nominal  Closed-Loop  Response  to  a  Ramped  Sinusoid  Input 


(b) 


Figure  4.5:  Simulated  Response  for  Nominal  System  using  Model- Reference- Based 
Controller;  =  10,  (  =  0.1:  (a)  Control  Force  (b)  Acceleration  Response. 
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Figure  4.7:  Simulated  Response  for  Nominal  System  using  Model- Reference- Based 
Controller  with  0.0003  Disturbance  Force;  u;;^T,/2w  =  10,  C  =  O-l-  (s-)  Control 
Force  (b)  .Acceleration  Response. 
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the  total  control  input  differs  from  the  feedforward  function  at  the  start  because 
the  feedback  loop  has  recognized  that  output  motion  is  lagging  behind  the  reference 
input.  Beyond  this  initial  transient,  the  control  input  is  just  as  before  e.Kcept  it 
includes  a  constant  force  offset  to  oppose  the  disturbance.  Settling  time  remains 
essentially  the  same  as  without  the  disturbance.  Thus,  the  model- reference- based 
control  scheme  achieves  response  comparable  to  that  for  an  open-loop  system,  even 
in  the  presence  of  a  disturbance  force. 


4.2.4  Discussion: 


.Although  this  feedforward/ feedback  control  scheme  seems  to  work  quite  nicely,  it 
has  a  number  of  drawbacks.  First,  derivatives  of  the  reference  position  (/*  undergo 
a  sudden  jump  to  zero  when  the  feedforward  input  ends  in  order  to  ensure  that 
any  residual  vibration  remaining  in  the  ideal  system  is  damped  out.  This  reference 
discontinuity  could  lead  to  a  control  input  that  excites  vibration  if  the  actual  system 
differs  significantly  from  the  nominal  system. 

Second,  the  feedforward  inputs  have  been  constructed  on  the  assumption  that 
the  only  dynamics  of  interest  are  the  reference  model  dynamics.  However,  if  the 
actual  system  is  sufficiently  different  from  the  reference  model,  additional  dynamics 
will  exist.  This  can  be  illustrated  by  determining  the  transfer  function  between  t/^ 
and  uj  in  terms  of  the  compensator  G(s},  reference  system  model  H^{s),  and  actual 
system 

I,  ,  rn  \IT  I  w  /  ,  ^ 

1 ^  ^  G{s)Hy{s))  (4.14) 

Ul{s)  1  -r  G(s)i74(s) 

.As  long  as  H^{s)  =  H^{s),  only  the  dynamics  of  H.\{s)  occur.  But  if  H^is)  ^ 
Hy{s),  then  more  complicated  dynamics  exist  which  have  been  ignored  in  the  design 
of  the  feedforward  inputs.  More  specifically,  the  natural  frequencies  of  the  closed- 
loop  system  will  appear,  although  these  have  been  neglected  in  the  design  of  the 
feedforward  inputs.  These  additional  dynamics  could  potentially  reintroduce  energy 
into  the  system  at  the  natural  frequencies  to  cause  undesirable  vibration.  Because 
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Figure  4.8:  Block  Diagram  of  PD  Controller  with  Shaped  Reference  Input. 

of  these  potential  difficulties,  we  looked  for  an  alternative  method  of  incorporating 
shaped  input  functions  into  a  closed-loop  system. 

4.3  Proportional-Derivative  Control  with  Shaped 
Reference  Input: 

4.3.1  Introduction: 

The  model- reference-based  control  scheme  presented  earlier  was  based  on  the  premise 
that  a  feedforward  function  could  be  tuned  to  a  nominal  system  whose  response 
could  then  be  imposed  on  the  actual  system.  An  alternative  formulation  would  use 
whatever  closed-loop  system  has  been  configured  as  the  basis  for  tuning  the  shaped 
input  functions.  Such  an  idea  has  already  been  proposed  in  connection  with  the 
posicast  c  ntfol  concept  developed  by  Smith  [16,  page  338].  In  this  section,  the 
frequency-shaped  inputs  will  be  tuned  to  the  closed-loop  natural  frequencies. 

In  many  respects,  the  new  closed-loop  system  model  of  Figure  4.8  resembles 
that  of  Figure  4.1.  But  there  are  important  differences.  First  of  all,  the  shaped 
force  input  no  longer  acts  as  a  direct  feedforward  input  to  the  control  force.  For 
sufficiently  stiff  systems,  this  extra  input  has  little  effect  on  the  response  and  was 
left  out  for  simplicity.  (Further  discussion  of  the  effect  of  a  feedforward  input  is 
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presented  in  Section  4.3.5.) 

.\nother  important  difference  is  the  use  of  a  simple  proportional-derivative  (PD) 
compensator  instead  of  the  optimal  compensator  presented  earlier.  There  were  a 
number  of  reasons  for  doing  this.  Motor  position  and  velocity  are  readily  available 
for  measurem.ent  in  most  practical  systems.  Thus,  no  estimator  with  its  inherent 
sensitivity  to  parameter  errors  and  unmodeled  modes  is  required  to  obtain  additional 
unmeasured  states.  Since  actuator  and  sensor  are  colocated,  the  system  is  much 
more  robust  to  modeling  errors  which  otherwise  could  lead  to  instability. 

The  full-state  optimal  compensator  is  designed  to  remove  the  resonant  charac¬ 
teristics  of  the  vibrating  system  by  replacing  them  with  its  own  set  of  dynamics.  In 
this  way,  the  compensator  is  trying  to  suppress  the  resonant  vibration,  whether  it 
be  excited  by  the  motion  or  by  a  disturbance.  However,  the  assumption  underlying 
the  present  work  is  that  the  motion  itself  causes  the  vibration  and  that  a  judicious 
choice  of  input  should  be  able  to  prevent'  the  resonant  vibration  from  occurring  at 
all.  To  fully  test  this  hypothesis,  a  simple  compensator  was  used  that  does  not  try 
to  suppress  the  resonant  vibration.  Such  a  compensator  also  keeps  the  controller 
simple  to  make  it  erisy  to  implement  on  existing  servo  systems. 

When  a  simple  controller  gives  adequate  positioning  accuracy  and  disturbance 
rejection,  development  of  shaped  inputs  to  reduce  residual  vibration  is  easier  than 
development  of  an  optimal  regulator  to  suppress  vibration.  An  optimal  regulator 
requires  a  system  model  with  reasonably  accurate  values  of  the  system  poles  and 
zeros.  Since  the  zeros  are  difficult  to  determine  and  are  likely  to  vary,  system 
performance  will  suffer.  Developing  shaped  inputs,  on  the  other  hand,  requires 
only  a  knowledge  of  the  poles  (natural  frequencies),  which  can  be  determined  to 
reasonable  accuracy. 

In  more  complicated  systems  in  which  an  optimal  regulator  is  necessary  to  ensure 
stability  and  disturbance  rejection,  the  use  of  shaped  inputs  can  still  give  beneficial 
results.  Conditions  for  which  shaped  reference  inputs  are  useful  in  conjunction 
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with  optimal  regulators  are  described  in  Section  4.4.  Thus,  the  use  of  a  simple 


PD  controller  in  the  following  discussion  is  not  intended  to  preclude  more  comple.x 


compensators,  but  rather  to  highlight  the  advantages  of  shaped  inputs. 


final  difference  in  the  new  control  scheme  of  Figure  4.8  is  that  the  reference 


system  model  has  been  replaced  by  a  double-integrator.  This  system  element  gener¬ 


ates  the  position  reference  from  the  shaped  force  profile.  Its  use  is  further  clarified 
in  Section  4.3.3.  The  compensator  used  on  the  reference  y*  is  the  same  as  the  PD 
compensator  to  ensure  good  tracking. 


4.3.2  Tuning  Shaped  Inputs  to  Closed-Loop  Systems: 


Since  the  effect  of  feedback  is  to  alter  the  dynamics  of  the  open-loop  system,  the 


shaped  inputs  should  be  tuned  to  the  closed-loop  system,  rather  than  the  open- 
loop  system.  In  this  way,  the  controller  can  operate  as  designed  to  ensure  accurate 
motion  in  the  presence  of  disturbances,  while  the  force  inputs  can  be  shaped  to 
avoid  exciting  any  closed-loop  resonances  that  occur. 

To  implement  this  strategy,  the  closed-loop  system  is  treated  as  an  equivalent 
open-loop  system.  Figure  4.9  shows  this  equivalence  in  block  diagram  form.  Note 


that  at  this  stage,  the  input  to  the  equivalent  open-loop  system  is  treated  as  a  force 


input  Uj  which  can  be  prespecified. 


Once  the  equivalent  open-loop  system  has  been  characterized  using  the  given 


functions  for  G(s}  and  Ilis),  its  natural  frequencies  can  be  identified  and  the  shaped 


force  input  can  be  derived  as  detailed  in  Chapter  2.  Note  that  the  frequencies  which 


are  to  be  filtered  from  the  input  spectrum  are  the  closed-loop  natural  frequencies. 


Consider  the  ideal  system  model  presented  in  Figure  4.2  with  transfer  function 


relating  motor  position  to  control  force  u*  given  by  equation  (4.3).  The  effect 


of  closing  the  loop  around  this  system  using  the  PD  controller  can  be  seen  in  a 
root  locus  plot  as  a  function  of  feedback  gains  (Figure  4.10).  The  damping  value 
is  assumed  to  be  0.1,  with  mxfm^  -  1.  For  simplicity  in  seeing  the  trend,  we  have 
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Figure  4.9:  Equivalent  Open-Loop  System. 

set  ki  =  Notice  that  the  open-loop  poles  very  rapidly  approach  the  open-loop 
zeros,  even  for  moderate  values  of  gain.  Thus,  we  can  safely  use  the  open-loop  zeros 
to  determine  the  closed-loop  natural  frequency  which  occurs  at  a  dimensionless 
frequency  (relative  to  the  open-loop  natural  frequency  of  =  0.7.  For  a 

value  of  .jL/f^TJ'lrr  =  10  as  used  in  Chapter  2,  the  shaped  input  tuned  to  the  closed- 
loop  natural  frequency  ijJcT,/2Tr  =  7  is  shown  in  Figure  4.11(a),  with  its  spectrum 
shown  in  (b). 

4.3.3  Generating  a  Shaped  Reference  Input: 

The  shaped  input  constructed  above  is  only  a  force  profile  that  must  now  be  incor¬ 
porated  into  a  closed-loop  controller.  Using  this  profile  uj  as  a  direct  input  to  the 
closed-loop  system,  as  shown  in  Figure  4.9,  will  not  work.  Since  the  closed-loop  con¬ 
troller  attempts  to  follow  the  specified  input,  in  this  case  the  shaped  force  profile,  the 
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Figure  4.10:  Root  Locus  of  Closed-Loop  Poles  with  PD  Controller  as  Function  of 


Feedback  Gains  ki  =  k2‘,  C  =  0-f- 


system  would  merely  move  away  from  and  ultimately  return  to  its  starting  position. 
Instead  of  specifying  a  force  profile,  we  need  to  specify  a  position  trajectory. 

One  way  to  do  this  would  be  to  use  the  nominal  open-loop  reference  system  or 
even  the  nominal  closed-loop  system  to  generate  a  position  profile  from  the  system 


response  to  the  shaped  input.  .As  pointed  out  in  the  discussion  on  the  model- 


reference- based  control  scheme,  this  element  in  the  block  diagram  will  introduce  its 
own  dynamics  into  the  closed-loop  transfer  function.  Since  the  shaped  inputs  are 
tuned  to  the  closed-loop  natural  frequencies,  it  makes  no  sense  to  introduce  the  open- 
loop  natural  frequencies  which  have  not  been  attenuated  in  the  force  profiles.  Using 
the  nominal  ctosed-loop  system  to  generate  a  position  trajectory  simply  reintroduces 


the  closed-loep  natural  frequencies. 


Perhaps  the  easiest  way  to  generate  the  position  trajectory  is  to  use  a  simple 
rigid-body  mass  having  the  combined  value  rrii  +  m^.  This  is  equivalent  to  retaining 
only  the  double-integrator  in  the  dimensionless  transfer  function  of  equation  (4. .3). 
eliminating  the  additional  resonant  frequencies.  This  generates  a  position  trajectory 


J., 
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that  can  be  directly  followed  by  the  PD  controller,  while  retaining  the  frequency¬ 
shaping  characteristics  of  the  original  force  profile. 

It  is  worth  noting  that  the  double-integrator  is  not  intended  to  act  as  a  filter. 
In  fact,  as  simulations  will  show,  a  doubly-integrated  square  wave  used  as  position 
trajectory  still  generates  considerable  residual  vibration. 

4.3.4  Closed-Loop  Simulation  Results: 

Using  the  damped  system  model  of  Figure  4.2  with  parameters  oJi^fTs/'lv  =  10, 
C  =  0.1.  mi/m2  =  1,  A-'i  =  k2  =  4,  and  the  force  profile  of  Figure  4.11,  we  obtained 
three  sets  of  simulation  results.  The  feedback  gains  A-q  and  ^2  were  chosen  to  give 
critical!/  damped  response  for  the  equivalent  rigid-body  system  with  closed-loop 
bandwidth  twice  the  natural  frequency.  In  the  first  simulation,  the  nominal  system 
with  =  1  was  used.  This  response  is  shown  in  Figure  4.12.  The  actual  control 

force  is  shown  in  (a),  while  the  acceleration  of  mass  m2  is  shown  in  (b).  The  residual 
vibration  has  indeed  been  eliminated.  Notice  also  that  the  control  force  differs  from 
the  shaped  force  profile  because  of  the  feedback  control  action.  Residual  amplitude 
is  very  nearly  the  same  as  that  of  the  open-loop  response  of  Figure  2.17. 

The  second  set  of  results  were  obtained  from  an  actual  system  model  having 
=  f'-9i  is,  the  actual  open-loop  natural  frequency  was  assumed  to  be 
10%  less  than  the  nominal  natural  frequency.  Since  this  error  puts  the  actual  natural 
frequency  at  the  extreme  low  end  of  the  spectral  notch,  the  damped  response  is 
expected  to  give  some  initial  residual  amplitude.  Because  the  PD  controller  gives 
very  lightly  damped  closed-loop  poles,  the  actual  response  shown  in  Fig.  4.13  takes 
longer  to  decay  than  that  with  the  optimal  compensator  (Fig.  4.6).  However,  the 
initial  residual  amplitude  is  smaller  for  the  PD  controller  because  the  input  has  been 
tuned  to  the  actual  closed-loop  dynamics.  The  model-reference-based  controller 
introduces  additional  dynamics  when  modeling  errors  are  present  which  increase 
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Actual  Closed-Loop  Response  to  a  Ramped  Sinusoid  Input 


(a) 


Actual  Closed-Loop  Response  to  a  Ramped  Sinusoid  Input 


(b) 


Figure  4.13:  Simulated  Response  for  Actual  System  Using  PD  Controller 
Ramped  Sinusoid  Input;  u}ffT,/2'K  —  10,  wcT,l27r  =  7,  C  =  0.1,  = 

(a)  Control  Force  (b)  Acceleration  Force. 
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A  third  simulation  gives  the  results  when  a  constant  opposing  force  of  dimen¬ 
sionless  amplitude  0.0003  acts  on  mass  This  represents  a  disturbance  which 
is  30%  of  the  peak  input  force.  The  ratio  is  again  assumed  to  be  1.  This 

response  is  shown  in  Figure  4.14.  Notice  how  the  closed-loop  feedback  compensates 
for  the  disturbing  force,  while  the  shaped  input  reduces  residual  vibration. 

To  point  out  the  advantages  of  using  the  frequency-shaped  profiles,  we  also 
simulated  the  response  to  a  square  wave  force  input  uj.  These  results  are  shown  in 
Figure  4.15.  .\t  the  end  of  the  move,  considerable  amplitude  of  residual  acceleration 
remains  that  must  be  damped  out  by  the  relatively  lightly  damped  clos’d-loop 
controller. 

4.3.5  Effect  of  a  Direct  Feedforward  Input: 

If  the  shaped  force  input,  uj  of  Figure  4.8,  is  fed  directly  into  the  controlled  system, 
the  new  block  diagram  will  look  like  Figure  4.16.  The  transfer  function  between  y‘^ 
and  when  this  feedforward  input  is  included  is  given  by 

(4.151 

lij(s)  S'll  ^  (ki  k2'S)ff4(s)l  ' 

This  compares  with  the  transfer  function  when  feedforward  is  absent: 


uj(s)  S'll  +  (ki -r 

Basically,  then,  the  feedforward  input  generates  an  additional  acceleration  reference 
signal.  This  will  tend  to  improve  tracking  performance  by  enhancing  the  higher- 
frequency  components  of  the  input  function  uj. 

.A.S  the  transfer  function  (4.15)  makes  clear,  the  use  of  a  direct  feedforward  signal 
will  enhance  frequencies  of  the  input  function  ii’j  above  the  break  frequency  given  by 
For  a  system  which  is  relatively  stiff,  with  large  A;i,  this  effect  is  insignificant. 
In  our  simulations,  we  used  a  value  Aq  =  4.  This  suggests  that  adding  the  di¬ 
rect  feedforward  connection  only  serves  to  enhance  frequencies  which  are  twice  the 
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Figure  4.14:  Simulated  Response  for  Nominal  System  Using  PD  Controller  with 
Ramped  Sinusoid  Input,  with  0.000.4  Disturbance  Force:  -  10,  •uJcT,/2'j  ~ 

7.  C  =0.1:  (a)  Control  Force  (b)  .Acceleration  Response. 
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Figure  4.15:  Simulated  Response  for  Nominal  System  Using  PD  Controller  with 
Square  Wave  Input;  uijs/T,/2Tr  =  10,  <jjcT,f'2Tr  =  7,  C  =  O-I-  (S’)  Control  Force  (b) 
Acceleration  Response. 
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Figure  4.16:  Block  Diagram  of  PD  Controller  with  Shaped  Reference  Input  Including 


a  Direct  Feedforward  Input. 


natural  frequency  of  the  system  and  higher.  When  the  dimensionless  closed-loop 
natural  frequency  ^cT,/  27r  is  7,  this  suggests  that  only  dimensionless  frequencies  of 
14  and  greater  will  be  enhanced  by  feedforward.  .\s  the  frequency  spectrum  of  Fig¬ 
ure  4.11(b)  shows,  there  is  very  little  energy  in  the  shaped  ramped  sinusoid  inputs 
above  u;r,/  27r  =  14.  Thus,  we  would  not  expect  feedforward  to  markedly  affect  the 


response  in  this  case. 


However,  for  systems  which  are  relatively  compliant,  the  additional  feedforward 


input  can  make  a  difference.  For  the  sake  of  argument,  assume  that  for  a  particular 


move  distance,  force  level,  and  inertia  value,  the  dimensionless  closed-loop  frequency 


aJcT,/2w  is  2.  Also,  assume  that  the  position  loop  is  relatively  compliant,  with  a 
value  ki  =  0.25.  This  suggests  that  a  direct  feedforward  input  will  amplify  the 
frequency  components  of  the  shaped  input  above  ^TJ2'k  =  1.  This  represents  a 


significant  part  of  the  input  spectrum,  as  shown  in  Figure  4.17(b). 


Simulation  results  comparing  responses  with  and  without  feedforward  are  shown 


in  Figures  4.18  and  4.19,  respectively.  The  total  control  input  u*  is  shown  in  (a). 


with  the  acceleration  of  mass  shown  in  (b).  The  response  does  lag  behind  a 


small  amount  when  the  direct  feedforward  signal  is  left  out.  But  even  under  these 


conditions,  the  advantage  in  using  feedforward  is  minimal. 

Thus,  the  effectiveness  of  a  direct  feedforward  signed  contributing  to  the  control 


ran  4^ 
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Figure  4.18:  Simulated  Response  to  Nominal  System  using  PD  Controller  with 
Ramped  Sinusoid  Input  and  with  Direct  Feedforward;  u;ArT,/27r  =  2.86,  u!cTJ2-k-  = 
2,  C  =  0.1;  (a)  Control  Force  (b)  Acceleration  Response. 
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Closed-Loop  Response  to  a  Ramped  Sinusoid  Input  without  Feedforward 
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Figure  4.19:  Simulated  Response  to  Nominal  System  using  PD  Controller  with 
Ramped  Sinusoid  Input  and  without  Direct  Feedforward;  u;/vT,/2x  =  2.86, 
uJcT,l2Tr  =  2,  C  =  0.1:  (a)  Control  Force  (b)  Acceleration  Response. 
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effort  is  related  to  the  stiffness  of  the  position  loop.  For  a  relatively  stiff  control  loop, 
feedforward  can  be  left  out  with  very  little  effect  on  performance.  For  compliant 
systems,  the  use  of  a  feedforward  input  may  speed  up  the  response.  This  would 
be  especially  useful  for  improving  the  performance  of  feedback  loops  which  require 
small  position  gains  for  stability. 

4.4  Suppressing  Vibration  Using  Optimal  Reg¬ 
ulators: 


4.4.1  Introduction: 

The  preceding  section  has  emphasized  the  use  of  shaped  reference  inputs  to  reduce 
residual  vibration.  The  PD  compensator  that  was  used  to  achieve  accurate  positions 
does  not  actively  suppress  vibration.  Instead,  excitation  of  system  natural  frequen¬ 
cies  is  minimized  by  using  appropriately  shaped  reference  inputs.  This  approach 
highlights  the  .effectiveness  of  shaped  inputs  but  ignores  vibration  suppression  that 
can  be  achieved  by  more  sophisticated  compensators.  Optimal  regulators  can  serve 
as  effective  controllers  to  actively  suppress  vibration  for  systems  having  several  nat¬ 
ural  frequencies.  This  section  discusses  optimal  regulators  and  identifies  several 
conditions  for  which  they  do  not  sufficiently  reduce  residual  vibration  without  the 
use  of  shaped  inputs. 

Two  different  cases  for  which  optimal  regulators  cannot  adequately  suppress 
vibration  will  be  investigated.  First,  we  will  show  that  optimal  regulators  can  only 
achieve  limited  closed-loop  damping  ratios  for  the  higher  frequency  modes.  Second, 
we  will  describe  a  system  having  a  mode  which  is  nearly  unobservable  and  therefore 
cannot  be  adequately  compensated. 

In  both  of  the  examples  used  to  illustrate  these  conditions,  we  will  apply  linear- 
quadratic-regulator  (LQR)  theory  to  develop  a  state  feedback  controller.  Feedback 


Figure  4.20:  Block  Diagram  of  Optimal  Regulator  State  Feedback  Controller. 


gains  were  determined  by  minimizing  the  following  performance  index, 


(4.17) 


where  represents  the  dimensionless  endpoint  position  whose  deviation  from  a 
^  desired  trajectory  we  wish  to  minimize,  and  u*  is  the  dimensionless  control  effort  of 
the  actuator.  We  will  assume  that  all  system  states  are  available  for  measurement 


to  simplify  the  analysis. 


State  feedback  derived  from  the  optimal  regulator  formulation  is  augmented  by 
a  reference  input  to  bring  the  system  to  the  desired  position.  The  complete  closed- 
loop  system  is  shown  in  Figure  4.20.  The  system  state  vector  x  is  multiplied  by  the 
state  feedback  gain  vector  kf .  The  reference  position  y'  is  multiplied  by  a  position 
gain  kr  that  causes  endpoint  position  y*  to  follow  the  reference. 

Finally,  the  reference  is  generated  by  doubly  integrating  a  square  wave  force 
profile  Uj.  Typically  a  simple  step  reference  would  be  used  to  achieve  the  desired 
position.  But  since  we  recognize  that  real  actuators  are  force-limited,  we  will  follow 
a  realistic  position  trajectory  which  achieves  time-optimal  motion  for  the  equivalent 
rigid-body.  The  task  of  the  state  feedback  regulator  is  to  maintain  this  trajectory 


by  minimizing  vibration  in  the  actual  system. 


Results  using  this  control  scheme  with  the  integrated  square  wave  input  will 
be  compared  with  results  using  the  ramped  sinusoid  force  input  to  generate  the 
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Table  4.2 


Definition  of  Dimensionless  Parameters 


t*  = 


ye 

ye  = 


(mi  +  m2  +  m2)yfuj\ 


reference.  The  shaped  force  input  is  also  transmitted  directly  to  the  system  as  a 
feedforward  signal  to  improve  response,  as  indicated  by  the  dotted  line  in  Figure  4.20. 
The  same  controller  is  used  regardless  of  reference  input.  These  comparisons  for  the 
two  cases  being  considered  serve  to  illustrate  the  importance  of  carefully  shaping  the 
reference  input  to  minimize  residual  vibration  when  the  optimal  regulator  cannot 
do  it  alone. 

4.4.2  Limited  Closed-Loop  Damping  Ratio: 

Even  though  optimal  regulators  are  designed  to  actively  damp  out  system  vibration, 
they  are  limited  in  the  amount  of  additional  damping  they  can  impose  on  the  system 
modes.  To  illustrate  this  phenomenon,  we  will  look  at  the  response  of  a  lightly- 
damped  three-mass  system  (Fig.  4.21).  The  dimensionless  parameters  used  for 
this  system  are  defined  in  Table  4.2,  where  j//  is  the  final  position  and  wi  is  the 
undamped  natural  frequency  of  the  first  mode  of  vibration.  The  second  mode  is 
given  in  dimensionless  form  as  Damping  ratios  for  the  first  and  second  modes 

are  Ci  and  Cs)  respectively.  The  transfer  function  relating  the  endpoint  position  y* 
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Figure  4.21:  Damped  Three- Mass  System  Model. 


to  the  control  effort  u*  is  given  by; 

y’As) 

u‘{s) 


(2Ci^  +  l) 

s2(s^  +  2Ci-s  +  1) 

+  2C,  (^)  ^  + 

(4.18) 


.\n  optimal  state  feedback  regulator  was  designed  for  this  system  using  a  control 
weight  p  =  1/49.  This  weighting  penalizes  endpoint  vibration  more  heavily  than  the 
control  effort.  System  parameters  were  chosen  so  that  u;2/u;i  =  2  and  Cl  —  C2  —  O'l* 
Results  when  the  square  wave  force  profile  generates  the  reference  for  a  dimensionless 
move  time  uixTJ'lv  =  1.5  are  shown  in  Figure  4.22.  The  control  effort  u*  is  shown  in 
(a)  and  the  endpoint  acceleration  y*  in  (b).  Even  though  the  first  mode  vibration  is 
damped  out  quickly  by  the  state  feedback  regulator,  the  second  mode  continues  to 
oscillate  for  several  cycles.  This  suggests  that  the  optimal  regulator  is  less  effective 
at  actively  damping  out  the  higher  frequency.  In  fact,  the  damping  ratio  of  the  most 
lightly-damped  closed-loop  poles  is  only  0.15. 

To  explain  why  optimal  regulators  give  lower  closed-loop  damping  ratios  for 
higher  modes,  we  will  look  at  the  typical  configuration  of  poles  in  optimally  regulated 
systems.  As  the  control  weight  p  approaches  zero,  all  the  closed-loop  poles  which  do 
not  go  toward  the  open-loop  zeros  will  approach  a  Butterworth  configuration  in  the 
left- half- plane  [68].  In  general,  a  lightly-damped  n-mass  system  like  that  of  Figure 
4.21  will  have  2n  open-loop  poles  and  n  —  1  real  zeros.  Thus,  n-l-1  closed-loop  poles 
will  approach  the  Butterworth  configuration.  Such  a  model  has  been  shown  to  be  a 
good  representation  of  dynamic  systems,  like  industrial  robots,  having  transmission 
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Figure  4.22:  Optimal  Regulator  Response  of  Three- Mass  System  using  Integrated 
Square  Wave  Reference  for  u!iT,l2Tr  =  1.5:  (a)  Control  Force  (b)  Acceleration  Re¬ 


sponse. 


w 

Sk!: 


4.4:  Suppressing  Vibration  Using  Optimal  Regulators: 


91 


compliance  and  structural  flexibility  [69).  The  number  of  masses  contained  in  the 
model  will  go  up  as  more  vibration  modes  are  included.  As  the  number  of  masses 
n  increases,  the  closed-loop  poles  closest  to  the  imaginary  axis  will  become  more 
and  more  lightly  damped.  For  n  =  2,  the  damping  ratio  is  0..o;  for  n  =  5.  it  is 
only  0.26.  Even  with  infinite  control  effort  available  (/>  =  0),  these  closed-loop  poles 
cannot  achieve  higher  damping  ratios  than  those  dictated  by  the  Butterworth  pole 
configuration. 

Often,  these  ideal  pole  locations  cannot  be  achieved  in  practice  because  of  band¬ 
width  limitations.  Since  the  dynamics  of  real  systems  cannot  be  precisely  known, 
some  modeling  error  can  be  expected.  Ignoring  some  of  the  higher  natural  frequen¬ 
cies  in  the  system  model  may  lead  to  instabilities  unless  control  gains  and  hence 
bandwidth  are  reduced  [36! .  Some  modeling  errors  can  lead  to  a  flip  in  the  rela¬ 
tive  locations  of  open-loop  poles  and  zeros  which  can  also  drive  a  system  unstable 
29] .  .Again,  bandwidth  must  be  reduced  to  guarantee  stability.  Under  these  cir¬ 
cumstances,  some  of  the  higher  frequencies  will  not  be  adequately  suppressed  by  the 
optimal  regulator  and  lightly  damped  residual  vibration  can  be  expected. 

When  we  use  a  shaped  ramped  sinusoid  force  profile  to  generate  the  reference 
trajectory  for  the  optimal  regulator,  residual  vibration  of  the  second  mode  can  be 
reduced.  The  ramped  sinusoid  input  function  we  used  was  constructed  to  minimize 
excitation  energy  at  two  frequencies:  aJiTj2Tr  =  1.5  and  ■jj-iTJ'Itt  =  3.  This  time 
function  is  shown  in  Figure  4.23(a),  with  its  frequency  spectrum  in  Figure  4.23(b). 
Response  of  the  three-mass  system  to  this  reference  input  is  shown  in  Figure  4.24. 
Notice  that  residual  vibration  has  been  minimized  for  both  natural  frequencies. 
Because  an  optimal  regulator  cannot  always  guarantee  well-damped  response,  it  is 
helpful  to  use  shaped  reference  inputs  to  generate  motions  which  do  not  excite  the 
lightly-damped  modes. 
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Figure  -4.24:  Optimal  Regulator  Response  of  Three-Mass  System  using  Integrated 
Ramped  Sinusoid  Reference  and  Feedforward  for  u;iT,/27r  =  1.5:  (a)  Control  Force 
(b)  Acceleration  Response. 
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Figure  4.25:  Two-Mass  System  Model  Exhibiting  Weakly  Coupled  Torsional  and 
Translational  Modes. 

4.4.3  Nearly  Unobservable  Modes: 

.\nother  case  in  which  optimal  regulators  fail  to  give  adequate  performance  is  in 
systems  having  nearly  unobservable  modes.  This  occurs  when  the  system  consists 
of  several  subsystems  that  are  only  weakly  coupled.  .A.  simple  e.xample  is  a  Cartesian 
robot  whose  axes  are  not  e.xactly  orthogonal  to  one  another.  In  that  case,  mocion 
in  an  axis  can  excite  vibration  in  the  other  axes.  Such  systems  are  characterized  by 
transfer  functions  having  open-loop  pole  and  zero  pairs  that  almost  cancel.  These 
poles  cannot  be  adequately  compensated  using  an  optimal  regulator. 

A  good  system  to  illustrate  this  kind  of  behavior  is  shown  in  Figure  4.25.  This 
system  is  basically  a  two-mass  system  but  the  second  mass  can  exhibit  rotation 
as  well  as  translation.  This  rotation  is  resisted  by  a  torsional  spring  K  and  damper 
B.  Such  a  model  may  be  used  to  represent  a  positioning  axis  riding  on  linear 
bearings,  which  have  a  certain  finite  stiffness.  The  endpoint  position  will  sense 
both  the  translation  and  the  rotation  of  the  second  mass  as  measured  at  the  edge  a 
distance  Cj  from  its  center  of  mass.  To  accurately  position  this  mass,  the  endpoint 
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Table  4.3 

Definition  of  Dimensionless  Parameters 


must  undergo  pure  translation.  That  will  be  the  goal  of  the  optimal  regulator. 

Because  any  asymmetries  in  friction  on  opposite  sides  of  mass  m2  will  cause  it  to 
pivot,  the  line  of  action  of  the  force  transmitted  through  the  spring  k  and  damper 
b  will  be  a  certain  distance  €2  from  the  center  of  mass  of  m2.  For  simplicity,  mass 
m2  will  be  assumed  to  be  square,  with  sides  of  length  2ei.  Thus,  its  mass  moment 
of  inertia  I  is  given  as 

/  =  1  mz  el-  (4.19) 

Dimensionless  parameters  can  be  defined  as  shown  in  Table  4.3.  The  desired  final 
position  yf  is  used  to  normalize  endpoint  position  y^.  The  undamped  natural  fre¬ 
quency  u;i  corresponds  to  the  frequency  for  the  purely-translating  two-mass  system 
(Fig.  2.13).  Another  natural  frequency  ^2  corresponds  to  torsional  vibration  of 
md.ss  /n2« 

Fk 

u;2  =  yy.  (4.20) 


In  dimensionless  terms,  this  second  mode  frequency  is  given  as  ui2l>jJ\.  Damping  ra¬ 
tios  of  the  first  and  second  modes  are  Ci  and  (2-  Additional  dimensionless  parameters 
used  in  this  model  are  the  ratios  mz/mi  and  ez/fi- 
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The  transfer  function  relating  the  endpoint  position  y‘  to  the  control  effort  u* 
can  be  expressed  as 

ylis)  0.17(s  ^  5.0)(s-  ^  0.025  T  4.7) 
ir(s)  s-(s2  +  0.2s  +  1.0)(s-- 0.02s  ^4.0) 

for  parameter  values  =  L  €21^1  =  0.1,  w<,’2/^i  =  2,  and  Ci  =  C2  -  0.1.  Notice 

the  presence  of  a  lightly  damped  pair  of  zeros  nearly  canceling  the  lightly  damped 

poles  representing  the  second  mode.  The  existence  of  these  zeros  near  the  vibrating 

poles  is  characteristic  of  systems  having  weakly  coupled  subsystems.  In  this  case, 

the  torsional  mode  is  only  weakly  coupled  to  the  remaining  two-mass  translating 

system. 

.A.n  optimal  regulator  can  be  derived  for  this  plant  model  and  combined  with  a 
reference  input  to  follow  a  specified  trajectory.  Control  weight  p  =  1/49  was  used  to 
determine  the  state  feedback  gains.  Rigid-body  response  to  a  square  wave  force  was 
used  as  a  reference  trajectory  (Fig.  4.20).  Results  for  a  dimensionless  move  time 
jj\T,j2Tr  =  1.5  arc  shown  in  Figure  4.26,  with  control  force  u*  in  (a)  and  endpoint 
acceleration  j/*  in  (b).  The  second  mode  continues  to  vibrate  for  a  considerable  time 
after  the  system  reaches  the  desired  position.  In  fact,  the  closed-loop  damping  ratio 
for  this  mode  is  only  0.03. 

This  response  can  again  be  explained  by  making  reference  to  the  closed-loop 
pole  configurations  of  optimal  regulators.  .As  control  weight  approaches  zero,  some 
of  the  closed-loop  poles  approach  the  open-loop  zeros.  As  the  transfer  function  (4.21 ) 
makes  clear,  two  of  these  poles  will  approach  a  pair  of  very  lightly  damped  zeros, 
having  damping  ratio  of  0.005.  No  matter  how  high  the  controller  bandwidth  is 
made  [p  smedl-),  this  pair  of  poles  will  always  dominate  and  give  vibratory  response. 

When  the  reference  trajectory  is  generated  from  a  doubly-integrated  ramped 
sinusoid  input  (  Fig.  4.23)  and  a  direct  feedforward  signal  is  added,  then  the  response 
of  Figure  4.27  results.  The  system  undergoes  the  same  move  =  1.5). 

Notice  that  this  time  the  residual  vibration  has  been  eliminated,  even  though  the 
same  state  feedback  compeuoator  was  used. 
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Figure  4.27:  Optimal  Regulator  Response  of  Weakly- Coupled  System  using  Inte¬ 
grated  Ramped  Sinusoid  Reference  and  Feedforward  for  u;iT,/27r  =  1..5:  (a)  Control 
Force  (b)  Acceleration  Response. 


These  examples  illustrate  the  advantage  of  using  frequency-shaped  reference  in¬ 
puts  in  order  to  improve  the  performance  of  state  feedback  control  systems.  When 
bandwidth  limitations  prevent  adequate  damping  ratios  of  higher  modes,  or  when 
nearly  unobservable  modes  prevent  effective  compensation  by  optimal  regulators, 
the  use  of  shaped  inputs  can  significantly  reduce  residual  vibration. 

4.5  Closure: 

This  chapter  has  presented  two  alternative  methods  of  incorporating  a  shaped  force 
input  into  a  closed-loop  system.  The  first  technique  uses  a  reference  model  of  the 
open-loop  system  to  impose  the  desired  performance  on  the  closed-loop  system. 
With  modeling  errors,  however,  this  control  scheme  can  introduce  closed-loop  nat¬ 
ural  frequencies  tha.  will  not  be  attenuated  by  force  profiles  tuned  to  the  open-loop 
natural  frequencies.  Therefore,  a  second  implementation  was  presented  that  tunes 
the  shaped  inputs  to  the  closed-loop  natural  frequencies.  .A.  simple  rigid-body  model 
of  the  system  generates  a  reference  position  profile  from  the  shaped  force.  .4  simple 
PD  compensator  is  used  to  illustrate  the  effectiveness  with  which  shaped  inputs 
alone  can  reduce  system  residual  vibration.  Then,  several  cases  were  presented 
for  which  even  an  optimal  regulator  provides  inadequate  performance.  The  use  of 
shaped  inputs  in  those  cases  helps  provide  good  response  with  minimum  residual 
vibration. 


Chapter  5 


Velocity-Limited  Systems 


5.1  Introduction: 

In  generating  force  profiles  up  to  this  point,  we  have  assumed  that  the  systems 
to  be  controlled  can  always  reach  peak  velocity.  Since  all  these  inputs  resemble  a 
single  cycle  of  a  square  wave,  the  move  consists  of  only  acceleration  and  deceleration 
regions.  No  time  is  spent  coasting  at  the  peak  velocity.  If  the  system  has  a  maximum 
allowable  speed,  the  force  input  must  be  scaled  down  until  the  peak  speed  achieved 
during  the  move  falls  within  the  velocity  limit.  This  can  lead  to  unnecessarily  long 
move  times  for  longer  moves.  .\n  alternative  is  to  develop  a  new  set  of  force  profiles 
that  allow  motion  at  constant  velocity  and  give  velocity  waveforms  resembling  a 
trapezoid.  Such  force  profiles  will  be  developed  in  this  chapter. 

Velocity  limits  can  occur  in  physical  systems  for  a  number  of  reasons.  Typically, 
peak  motor  velocity  is  limited  by  saturation  in  the  amplifiers.  With  a  limited  supply 
voltage  available  to  the  amplifier,  the  motor  can  accelerate  only  up  to  a  speed  where 
this  voltage  just  cancels  the  voltage  drop  across  the  winding  resistance  and  the  back 
emf  voltage.  A  plot  of  motor  velocity  as  a  function  of  time  for  a  typical  amplifier 
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Figure  5.1:  Motor  Velocity  for  a  Typical  Saturating  Amplifier. 

giving  full  voltage  output  is  shown  in  Figure  5.1.  Notice  that  a- velocity  limit  is 
reached  gradually.  Other  possible  reasons  for  limiting  peak  velocity  are  requirements 
on  the  speed  with  which  balls  can  circulate  in  a  lead  screw  or  requirements  on 
decelerating  large  inertial  loads. 

In  this  chapter,  we  will  develop  open-loop  force  profiles,  analogous  to  the  ramped 
sinusoid  functions  of  Chapter  2,  that  accelerate  a  two-mass  system  to  a  specified 
velocity.  These  open-loop  functions  will  be  used  directly  to  accelerate  this  system  to 
peak  velocity,  and  will  then  be  incorporated  into  the  closed-loop  scheme  presented 
in  Chapter  4.  Finally,  a  complete  force  profile  will  be  constructed,  consisting  of 
acceleration,  dwell,  and  deceleration  regions,  to  achieve  any  desired  position. 

5.2  Development  of  Shaped  Functions; 

Typical  systems  with  velocity  limits  approach  peak  velocity  gradually.  The  accel¬ 
eration  during  this  period  is  constantly  decreasing.  Thus,  the  force  or  torque  that 
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can  be  applied  during  acceleration  is  a  maximum  initially  and  then  decreases.  Since 
the  exact  nature  of  this  allowed  force  variation  with  time  depends  on  the  type  of 
amplifier  being  used,  as  well  as  other  system  characteristics,  we  decided  against 
trying  to  model  this  time-varying  force  signal.  V\'e  chose  instead  to  approximate 
the  open-loop  force  profile  by  assuming  that  the  acceleration  (and  deceleration)  are 
constant.  This  can  be  accomplished  by  using  constant  force  during  acceleration  and 
deceleration.  While  the  system  is  coasting  at  the  peak  velocity,  the  input  force  is 
zero.  This  is  only  true  under  ideal  conditions  when  no  damping  to  ground  or  friction 
is  present.  However,  feedback  control  can  be  used  to  compensate  for  this  effect. 

The  trapezoidal  velocity  waveform  that  results  from  the  use  of  constant  accel¬ 
erating  and  decelerating  force  pulses  is  necessarily  slower  than  the  actual  velocity 
profile  if  saturation  is  to  be  avoided.  But  acceleration  and  peak  velocity  can  be  ad¬ 
justed  to  give  a  trapezoidal  profile  that  optimally  fits  within  the  actual  achievable 
profile.  Details  of  this  development  are  given  in  Chapter  6.  Thus',  even  though  a 
trapezoidal  velocity  waveform  is  not  the  best  response  that  a  particular  system  can 
achieve,  it  serves  as  a  reasonably  faist  reference  response  that  avoids  saturation. 

In  order  to  produce  a  trapezoidal  velocity  profile  having  a  constant  velocity- 
region  where  the  speed  remains  constant,  the  force  profile  must  consist  of  three 
regions:  acceleration,  dwell,  and  deceleration.  Ideally,  the  acceleration  and  deceler¬ 
ation  regions  resemble  rectangular  pulses  in  order  to  optimally  utilize  the  available 
force.  However,  with  their  large  discontinuities,  these  pulses  cause  considerable  vi¬ 
bration  when  applied  to  the  system.  Thus,  a  smooth  version  of  a  rectangular  pulse  is 
needed  that  has  energy  removed  at  the  system  natural  frequency.  This  force  profile 
win  accelerate  the  system  to  peak  velocity. 

Such  a  smooth  profile  can  be  constructed  from  a  versine  (1— cosine)  function, 
shown  in  Figure  5.2.  Notice  that  there  are  no  discontinuities  in  slope  at  the  beginning 
and  end.  W'hen  higher  harmonics  of  this  function  are  added  to  the  fundamental, 
a  function  resembling  a  rectangular  pulse  can  be  created.  The  coefficients  of  the 
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Normalized  Time 

Fundameatal  Venine  Function 

Figure  5.2:  Fundamental  Versine  Function. 

harmonics  can  be  chosen  to  minimize  the  energy  of  the  resulting  function  at  the 
system  natural  frequency.  This  requires  that  the  frequency  spectrum  of  the  function 
be  minimized  at  the  natural  frequency.  This  can  be  accomplished  by  performing  an 
optimization  in  a  manner  anadogous  to  that  done  for  the  ramped  sinusoid  functions 
of  Chapter  2.  Preliminary  discussion  of  this  development  is  soon  to  be  published  70l. 
Shaped  input  functions  will  be  constructed  for  a  two-mass  system  as  before  (Fig. 
5.3).  having  undamped  natural  frequency  u;„  and  dimensionless  parameters  as  given 
in  Table  5.1.  The  parameter  Vp  represents  the  peak  velocity  and  T/j  represents  the 
time  to  move  the  equivalent  rigid-body  mass  to  peak  velocity  Up  using  a  rectangular 
pulse  input  having  peak  force  F.  As  in  Chapter  2,  dimensionless  parameters  use  the 
nominal  natural  frequency  while  the  actual  natural  frequency  is  represented 
by  the  ratio  u;4/a;v  To  simplify  the  derivation  of  the  shaped  versine  inputs,  an 
undamped  system  model  will  be  assumed,  which  has  a  damping  ratio  (  of  zero. 

In  general,  the  input  functions  can  be  represented  by  the  following  series  expan- 


.5.2;  Development  of  Sbhped  Functions: 


105 


sion,  where  B(  is  the  coefficient  for  each  harmonic,  and  Tp  represents  the  time  for 
the  versine  response  to  reach  peak  velocity; 


/U)  = 

(=i 


(5.1) 


=  1  —  cos 


2xff 


i  =  1,2,3,.. 


(5.2) 

(5.3) 


The  goal  is  to  choose  appropriate  values  for  B(  that  will  minimize  the  time  Tp 
and  minimize  the  magnitude  of  the  frequency  spect’-um  over  a  range  of  frequencies 
surrounding  the  system  resonant  frequency  u^n. 

To  achieve  this,  we  will  combine  these  objectives  into  a  single  minimization  prob¬ 
lem  to  pick  the  coefficients  B(.  To  minimize  Tp,  we  will  minimize  the  square  of  the 
difference  between  the  versine  series  and  a  rectcingular  pulse.  In  addition,  a  sec¬ 
ond  e.xpression  will  be  added  to  minimize  the  squared  magnitude  of  the  frequency 
spectrum  F*  at  several  frequencies  ui,  surrounding  the  system  resonance.  A  weight¬ 
ing  factor  p  determines  relative  weighting  between  these  objectives.  The  overall 
objective  function  J  represents  the  quantity  to  be  minimized. 

11 


J  =  ^  r^  i  -  f{t)\^dt  ^ 

ip  Jo 


)i 


(5.4) 


1=1 


In  this  formulation,  we  have  chosen  11  frequencies  surrounding  resonance  to  satisfy 
the  spectral  magnitude  constraint.  The  upper  and  lower  limits  on  frequency  can 
be  adjusted  to  give  any  desired  frequency  band.  For  a  ±10%  frequency  range,  the 
bounds  on  the  frequency  u;,  are  O.Ou;,,  <  j;,  <  l.lu;„. 

The  coefficients  of  the  harmonics  Bt  can  be  calculated  by  differentiating  the 
objective  function  J  with  respect  to  B^,  where  r  represents  a  particular  value  of  the 
inde.x  f,  and  setting  the  result  to  zero.  'T'his  gives  an  expression  explicitly  in  terms 
of  Bf  and  I'.,: 
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If  the  time  Tp  is  known  then  /'^  is  known  and  the  coefficients  B(  can  be  deter¬ 
mined  by  simply  solving  the  following  set  of  bnear  equations,  expressed  in  matrix 


form: 


•KM  =  ill 


where  Ij  is  a  vector  of  I’s.  Unfortunately,  Tp  is  not  known  until  the  coefficients  B( 


are  known.  The  dependence  of  Tp  on  5/  is  given  by 


Tp  =  Tv  Tr 


where 


Tv  = 


(5.10) 


Th  = 


(mi  -  rni)Vp 


SF  is  a  scale  factor  which  normalizes  the  peak  of  the  function  to  1.  Tr  represents  the 
time  to  reach  peak  velocity  Vp  when  the  input  is  a  rectangular  pulse  of  magnitude  F. 
Fv  is  a  function  of  B(  that  ensures  that  the  resulting  input  signal  brings  the  system 
to  the  desired  velocity.  Since  the  versine  functions  cannot  supply  as  much  energy  for 
the  same  peak  force  as  the  corresponding  rectangular  pulse,  they  will  take  slightly 
longer  to  reach  peak  velocity.  This  time  penalty  is  represented  by  Fv'. 


Due  to  the  inherent  coupling  of  B(  and  F^,  an  iteration  scheme  is  necessary  to 


correctly  compute  values  for  the  coefficients  £?<.  This  iterative  procedure  is  com¬ 


pletely  analogous  to  that  for  the  ramped  sinusoid  functions  of  Chapter  2: 


1.  Determine  uinTR  for  given  peak  velocity  and  system  parameters. 
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2.  Guess  a  value  of  Fv^.  (Note  that  Fv  is  slightly  greater  than  1.) 

3.  Solve  for  B(  by  solving  the  matrix  equation  (o.8). 

4.  Normalize  the  versine  series  expansion  by  determining  the  value  for  the  scale 
factor  SF. 

5.  Calculate  F using  expression  (5,10). 

6.  Use  the  new  value  of  F;-  to  update  B(. 

7.  Repeat  until  Fv  converges  to  acceptable  accuracy  (error  with  respect  to  pre¬ 
vious  value  is  less  than  10“’). 

Using  the  procedure  outlined  above,  we  can  derive  functions  that  satisfy  our 
objectives.  We  used  a  total  of  L  =  15  terms  for  computational  efficiency  while 
retaining  enough  parameters  to  achieve  acceptable  minimization.  .\  good  compro¬ 
mise  between  minimizing  acceleration  time  Tp  and  minimizing  spectral  magnitude 
is  achieved  for  a  value  of  p  =  iO.  Note  that  larger  values  of  p  will  give  lower  spectral 
magnitudes  and  slightly  longer  acceleration  times.  Results  for  two  nominal  values  of 
the  dimensionless  parameter  o-nTfi /2t  (7  and  10),  minimizing  spectral  magnitudes  at 
11  frequencies  extending  ±10%  around  resonance,  are  shown  in  Figures  5.4  and  5.5. 
The  time  function  is  shown  in  (a)  and  the  frequency  spectrum  is  shown  in  (b).  No¬ 
tice  that  the  spectral  magnitudes  for  the  entire  range  of  frequencies  extending  xl0% 
about  have  been  significantly  attenuated. 


5.3  Shaped  Versine  Inputs  for  Several  Natural 
Frequencies: 


The  approach  outlined  in  the  previous  section  can  also  be  extended  to  minimize 
excitation  energy  at  several  natural  frequencies.  The  new  objective  function  can  be 
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expressed  as 


1  r^p  ■, 

Ip  Jo 


5.12; 


where  M  is  the  total  number  of  modes  (natural  frequencies)  to  attenuate,  and  uj,  is 
given  by 

(1  Pm)^  m  ^  '  (f  ^  P  tn  )^m  '  ^  ^  1  •  •  •  ?  f  frn  (  0 . 1 3  ) 


where  Pm  represents  the  fraction  of  nominal  frequency  that  determines  the  upper 
and  lower  bounds  of  the  frequency  band  surrounding  the  nominal  natural  frequency 
o-’m  for  the  mth  mode. 

When  this  minimization  is  carried  out  as  before,  a  new  set  of  coefficients  are  de¬ 
termined.  A  versine  input  attenuating  three  natural  frequencies  at  u;^T,/2t  =  1.5, 
5.  and  10  with  10%  frequency  bands  is  shown  in  Figure  5.6(a),  with  corresponding 
frequency  spectrum  in  (b).  Notice  that  all  three  frequencies  have  been  attenuated 
as  specified. 


5.4  Shaped  Versine  Inputs  for  Lightly-Damped 
Systems: 


In  section  2.6  of  Chapter  2,  we  presented  results  that  showed  the  effect  of  inherent 
system  damping  on  the  residual  acceleration  amplitudes  when  the  system  is  driven 
by  a  particular  shaped  input.  We  can  now  apply  those  results  to  the  versine  functions 
developed  here.  We  will  use  the  single- resonance  model  (Fig.  5.3)  for  simplicity. 

The  entire  development  follows  exactly  as  in  Chapter  2,  except  that  the  Fourier 
transform  of  the  versine  function  is  expressed  as 

F(v*.’)  =  (5.14) 


where 


FT 

Fr{u^)  =  2  ^ 


SF 


E 


5^2x0^  sin  ^ 


f-;u;rf(2xf)2-(^Tp)21 


(5.15) 


5.4:  Shaped  Versine  Inputs  for  Lightly- Damped  Systems: 


111 


Dimensionless  Time 


Versine  Input 


Dimensionless  Frequency 


Frequency  Spectrum  of  Versine  Input 


Figure  5.6:  Versine  Input  Tuned  to  u>„Tfl/27r  =  1.5,  5,  and  10±%:  (a)  Time  Func 
tion  (b)  Frequency  Spectrum. 
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5.5;  Closed-Loop  Simulation  Results: 
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Figure  5.9:  Residual  Acceleration  .Amplitude  as  a  Function  of  for  Versine 

Input  Tuned  to  =  10  ±  10%;  C,  =  0.3. 

of  frequency  resembles  the  frequency  spectrum  of  the  versine  input  (Figure  5.5).  It 
differs  from  the  frequency  spectrum  because  it  represents  yJnTn  times  the  frequency 
spectrum.  As  C  increases  from  C  =  O.I  in  Figure  5.8  to  =  0.3  in  Figure  5.9, 
the  residual  acceleration  function  becomes  smoother,  the  valleys  rise  and  the  peaks 
drop.  In  general,  the  range  of  frequencies  over  which  good  vibration  attenuation  is 
maintained  is  reduced  as  the  damping  ratio  increases. 

For  lightly  damped  systems,  the  effect  of  damping  is  small  enough  that  ver¬ 
sine  inputs  with  notched  frequency  spectra  will  work  quite  well.  For  more  heavily 
damped  systems,  the  expression  (5.17)  for  residual  acceleration  could  be  inserted 
into  the  objective  function  J  of  (  5.4)  in  place  of  the  frequency  spectrum.  This  would 
ensure  small  residual  vibration  over  the  specified  frequency  range. 


5.5  Closed-Loop  Simulation  Results: 


The  force  profiles  that  we  have  just  developed  are  suitable  for  open-loop  implemen¬ 
tation,  where  force  inputs  can  be  directly  specified.  In  closed-loop  systems,  however. 


5.5:  Closed-Loop  Simulation  Residts: 


115 


the  for^c  input  is  typically  determined  by  the  combination  of  a  reference  trajectory 
and  several  feedback  signals.  Thus,  only  by  specifying  a  reference  trajectory  can  the 
force  input  be  affected. 

VVe  will  again  use  the  closed-loop  control  scheme  proposed  in  Section  4.3  of 
Chapter  4.  .A.  damped  two-mass  system  model  is  used  as  the  plant  (Fig.  4.2). 

Motor  position  and  velocity  are  measured  and  fed  back  with  gains  ki  and  k2  as 
shown  in  Figure  4.8.  This  represents  a  simple  PD  controller.  The  control  input 
u’  is  generated  from  a  reference  signal  (/*  and  from  the  motor  feedback  position 
and  velocity.  An  advantage  of  this  control  scheme  is  its  stability  robustness  when 
system  parameters  change.  Stability  robustness  improves  when  actuator  and  sensor 
are  colocated  at  the  motor. 

The  force  profile  used  in  this  control  scheme  must  be  tuned  to  the  closed-loop 
naturcil  frequencies.  For  the  PD  feedback  loop  with  ki  =  1-2  =  4.  the  dominant 
closed-loop  natural  frequency  fs  70%  of  the  open-loop  natural  frequency.  Thus,  the 
versine  force  profile  should  be  tuned  to  a  natural  frequency  which  is  70%  of  the 
open-loop  natural  frequency. 

Once  the  proper  force  profile  has  been  tuned  to  the  closed-loop  system,  the 
corresponding  reference  trajectory  can  be  determined.  The  reference  trajectory  y' 
is  generated  by  doubly  integrating  the  force  profile  uj.  This  generates  a  position 
reference  signal  which  contains  very  little  energy  at  the  specified  closed-loop  natural 
frequency. 

For  a  system  model  with  parameter  ojyTnj'lT  =  10,  where  uiy  represents  the 
nominal  open-loop  natural  frequency,  the  shaped  input  must  be  tuned  to  = 

7,  where  corresponds  to  the  closed-loop  natural  frequency.  This  force  profile  is 
shown  in  Figure  5.4(a).  Using  this  force  profile  in  the  closed-loop  control  system 
leads  to  the  simulation  results  shown  in  Figure  5.10.  The  actual  control  force  u'  is 
shown  in  (a),  while  the  endpoint  acceleration  of  the  mass  distant  from  the  motor  is 
shown  in  (b).  When  the  force  ends  near  the  dimensionless  time  of  15,  the  system 
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Figure  5.10:  Simulated  Closed-Loop  Response  for  Nominal  System  Accelerating  to 
Peak  Velocity  with  Versine  Input;  u>nTr/2‘t  =  10,  ujcTR/2ir  =  7,  (  =  0.1:  (a) 
Control  Force  (b)  Endpoint  Acceleration  Response. 
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has  reached  peak  velocity.  As  the  acceleration  signal  indicates,  the  system  achieves 
peak  velocity  with  very  little  vibration  remaining  as  it  begins  its  constant  velocity 
region. 

The  situation  described  above  represents  the  case  when  the  closed-loop  natural 
frequency  is  known  exactly.  When  the  actual  system  frequency  differs  from  the 
nominal  natural  frequency  for  which  the  inputs  were  constructed,  the  simulation 
response  of  Figure  .5.11  results.  In  this  case,  the  ratio  of  actual  natural  frequency  to 
nominal  natural  frequency  was  assumed  to  bea;4/a,-,v  =  0.9.  Notice  that  the  residual 
vibration  has  increased  compared  to  that  when  no  error  in  natural  frequency  exists. 
This  is  due  to  the  effect  of  damping.  However,  the  response  is  still  quite  good  despite 
the  error  in  natural  frequency. 

It  is  instructive  to  compare  these  results  with  the  response  obtained  by  simply 
using  a  rectangular  pulse  as  the  force  profile.  Simulation  plots  for  that  case  are 
shown  in  Figure  5.12,  again  with  control  force  in  (a)  and  endpoint  acceleration  in 
(b).  Notice  that  considerable  vibration  occurs  when  peak  velocity  is  reached  after 
11  dimensionless  time  units,  and  this  has  not  decayed  to  the  level  achieved  by  the 
shaped  profile  even  after  20  dimensionless  time  units.  Thus,  the  shaped  versine 
profile  achieves  peak  velocity  with  considerably  less  vibration  than  the  rectangular 
pulse. 

5.6  Development  of  Shaped  Inputs  to  Reach  a 
Specified  Position: 

So  far  in  this  chapter,  shaped  inputs  have  been  developed  in  order  to  accelerate 
a  vibrating  system  to  peak  velocity  with  minimum  residual  vibration.  In  order  to 
arrive  at  a  desired  position,  the  system  must  also  be  brought  from  peak  velocity  to 
rest  using  a  shaped  decelerating  force  profile.  This  can  be  accomplished  by  using 
exactly  the  same  force  profile  as  for  acceleration  but  with  the  opposite  sign.  The 
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Figure  5.11;  Simulated  Closed-Loop  Response  for  Actual  System  Accelerating  to 
Peak  Velocity  with  Versine  Input;  u!nfTfil2‘K  =  10,  uicTRl2Tr  =  7,  C  =  0.1,  - 

0.9:  (a)  Control  Force  (b)  Endpoint  Acceleration  Response. 
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j.d:  Development  of  Shaped  Inputs  to  Reach  a  Specified  Position: 


only  remaining  parameter  to  be  determined  is  the  time  for  which  the  system  moves 
at  peak  velocity. 

In  order  to  ensure  that  the  system  arrives  at  the  desired  final  position  (/f.  the 
dwell  time  at  which  the  system  moves  at  constant  velocity  Vp  should  be  deter¬ 


mined  as  follows: 


^  _  T 


In  dimensionless  form,  this  can  be  rewritten  as 


—  y]  —  ->JyTp- 


(5.24) 


.\  typical  force  profile,  with  the  corresponding  velocity  profile  and  position  tra¬ 
jectory  is  shown  in  Figure  .5.13.  Notice  that  the  velocity  resembles  a  trapezoidal 
profile. 

For  a  dimensionless  distance  yj  giving  a  dwell  time  of  =  u!,\Tp  for  the 

versine  input,  the  simulated  nominal  system  response  with  PD  feedback  is  as  shown 
in  Figure  -5.14.  Notice  that  the  acceleration  amplitude  remains  low  after  both  the 
acceleration  and  the  deceleration  phases  of  the  motion. 

In  comparison,  the  rectangular  pulse  input  for  the  same  distance  has  a  dwell 
time  of  •jJsfTd  =  y’f  —  u/yTfi.  This  is  longer  than  the  dwell  time  for  the  versine  input 
since  the  system  accelerates  and  decelerates  more  rapidly  with  the  rectangular  pulse 
input.  System  response  for  the  rectangular  pulse  input  is  shown  in  Figure  5.15.  .A.s 
before  (Figure  5.12),  there  is  considerably  more  vibration  after  acceleration  and 
deceleration  with  the  rectangular  pulse  input  than  with  the  versine  input. 

.A.  comparison  of  move  times  shows  that  the  rectangular  pulse  input  is  faster 
if  the  additional  settling  time  is  ignored.  But  this  time  advantage  is  lost  by  the 
additional  time  required  for  the  vibration  to  settle.  For  longer  moves,  the  versine 
time  penalty  becomes  comparatively  smaller  because  the  longer  acceleration  time 
becomes  a  smaller  fraction  of  total  move  time.  This  can  be  seen  by  expressing  total 
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Figure  5.15:  Simulated  Closed-Loop  Response  for  Nominal  System  Moving  a  Spec 
ified  Distance  with  Rectangular  Pulse  Input;  y)l2ir  =  28.6,  u;yvT'fl/27r  =  10 
ijjcTRl2Tr  =  7,  C  =  0.1:  (a)  Control  Force  (b)  Endpoint  Acceleration  Response. 
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move  time  as 


^sTf  -  2aj_^Tp  ~  ^sTd  -  y}  ~  ^\Tp  =  y)  ~  Tv'^'nTr.  (5.25) 

The  effect  of  Fv  >  1  becomes  smaller  as  the  distance  y*f  increases.  Thus,  the  time 
penalty  in  shaping  the  inputs  becomes  less  important  for  longer  moves. 

.A.n  additional  advantage  of  versine  inputs  is  that  for  a  given  set  of  system  pa¬ 
rameters  and  peak  velocity,  only  a  single  shaped  function  needs  to  be  derived  for 
all  moves  which  are  long  enough  to  at  least  reach  peak  velocity.  This  can  greatly 
simplify  the  computations  needed  to  develop  inputs  for  any  desired  position.  In 
comparison,  the  ramped  sinusoid  inputs  need  to  be  rederived  for  each  new  position. 

For  distances  which  are  short  enough  that  the  system  cannot  reach  peak  velocity, 
the  ramped  sinusoid  inputs  are  preferred.  This  is  because  they  only  reduce  vibra¬ 
tion  at  the  end  of  the  move,  while  the  versine  inputs  reduce  vibration  after  both 
the  Acceleration  and  the  deceleration  phases.  These  more  stringent  constraints  on 
the  versine  input  generally  increase  the  total  move  time  compared  to  the  ramped 
sinusoid  input.  Thus,  ramped  sinusoid  inputs  should  be  constructed  for  all  moves 
which  can  just  reach  peak  velocity.  For  all  longer  moves,  the  versine  inputs  should 
be  used. 


5.7  Closure: 

This  chapter  has  presented  the  development  of  a  new  set  of  functions  that  can 
be  used  for  systems  having  a  velocity  limit.  Shaped  versine  inputs  can  accelerate 
and  decelerate  the  system  with  very  little  residual  vibration.  The  total  time  to 
cover  a  specified  distance  is  longer  for  these  shaped  inputs  than  for  rectangular 
pulse  inputs.  But  rectangular  pulse  inputs  generate  residual  vibration  that  requires 
additional  time  to  damp  out.  For  longer  moves,  the  time  penalty  associated  with 
shaped  versine  inputs  becomes  less  important.  With  moves  long  enough  for  the 
system  to  reach  peak  velocity,  the  versine  input  need  only  be  constructed  once  and 
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only  the  dwell  time  must  be  altered  to  arrive  at  any  desired  position.  For  shorter 
moves,  the  ramped  sinusoid  functions  of  C  hapter  2  must  be  determined  for  each 


desired  move  distance. 


Robot 


Chapter  6 


6.1  Introduction: 


Having  presented  a  set  of  shaped  force  inputs  and  a  control  scheme  in  which  they  can 
be  incorporated,  we  are  now  in  a  position  to  apply  these  inputs  to  a  physical  device 
-  the  MIT  Cartesian  Robot  i71,72j.  This  chapter  will  develop  a  detailed  model 
of  the  robot  structure,  actuators,  and  digitally-implemented  control  loop.  Once 


this  model  has  been  verified  by  experimental  results,  it  will  be  used  to  determine 


optimum  parameters  for  the  velocity  profile  generating  a  specified  motion. 

The  MIT  robot  was  designed  for  stiffness  and  speed.  A  schematic  is  shown 
in  Figure  6.1.  A  Cartesian  configuration  was  chosen  in  order  to  minimize  coupling 
between  axes  and  to  simplify  trajectory  calculations.  This  arrangement  also  permits 
higher  stiffnesses.  The  cantilevered  top  frame  permits  maximum  access  to  the  robot 


workspace.  Structural  members  are  constructed  of  steel  box  sections  welded  and 


bolted  together.  Moving  elements  are  made  of  hollow  aluminum  weldments  for 
maximum  stiffness-to-weight  ratio. 

The  moving  elements  -  X,Y,  and  Z  carriages  -  move  on  cam  rollers  stiffly 
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Figure  6.2:  Block  Diagram  Model  of  .\ctuator. 

preloaded  against  ground  steel  ways.  Three  .Aerotech  DC  permanent  magnet  motors 
drive  the  axes.  Ground  ball  screws  convert  motor  rotation  to  translation  of  the  X 
and  Y  carriages.  The  Z-axis  uses  a  rack  and  pinion  drive.  Further  details  on  the 
design  and  construction  of  the  MIT  robot  can  be  found  in  Vaaler  Tlj  and  Podoloff 
;"2].  ' 

Power  for  the  .A.erotech  motors  comes  from  an  .\utomatix  pulse-width-modu¬ 
lating  amplifier-  which  uses  both  current  and  tachometer  feedback.  Motor  voltage  is 
supplied  by  varying  the  pulse  width- of  a  19.4  kHz  pulse  generator  having  a  supply 
voltage  of  150  volts.  The  inductance  in  the  motor  effectively  filters  this  pulsing 
signal  to  generate  smooth  motion.  Further  details  on  the  amplifier  are  contained  in 
Nussbaum  i73)  and  Drlik  [74]. 

6.2  Actuator  Model; 

.A  block  diagram  model  of  the  actuator  can  be  developed  by  representing  the  dy¬ 
namics  of  the  amplifier  and  the  DC  motor.  This  model  is  shown  in  Figure  6.2.  For 
the  time  being,  the  robot  axis  is  treated  simply  as  a  rigid-body  inertia,  with  viscous 
damping  and  friction. 

The  input  to  this  model  is  a  voltage  command  which  specifies  the  desired 
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Figure  6.3:  Block  Diagram  Model  of  Closed-Loop  Controller. 

velocity.  This  is  compared  with  the  tach  velocity  signal  and  amplified  in  the  pream¬ 
plifier  section.  This  generates  a  current  command  which  is  compared  with  the 
measured  current  signal  to  regulate  the  pulse  width  of  the  voltage  signal  to  the 
motor. 

The  motor  model  includes  the  effects  of  winding  resistance  R  and  inductance  L. 
The  motor  generates  a  torque  proportionad  to  current  i  and  develops  a  back  emf 
voltage  proportional  to  rotational  velocity  u;. 

The  transfer  function  relating  the  speed  u;  to  the  velocity  command  can  be 
expressed  as 

^amp  Rprt _  ^  ^ 

( 

Treating  this  actuator  model  as  a  single  block  to  represent  the  hardware,  a  com¬ 
plete  block  diagram  of  the  closed-loop  position  controller  implemented  in  software 
is  shown  in  Figure  6.3. 

Computer  control  of  the  robot  is  achieved  by  a  hierarchical  software  architecture. 
.A  PDF  lt/23  minicomputer  runs  FORTH  words  that  download  commands  to  a  set 
of  Intel  8031  microprocessors,  one  for  each  axis.  The  PDP  11/23  is  also  connected  to 
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a  V  AX  780  running  in  UNIX  that  can  be  used  for  generating  complicated  trajectory 
profil‘'s  and  for  plotting  data.  detailed  presentation  of  the  computer  controller 
can  be  found  in  Benjamin  i7oj. 

In  the  block  diagram  of  Figure  6.3,  the  position  measurement  is  obtained  from 
an  optical  encoder  mounted  behind  the  tachometer  on  each  motor.  Velocity  is 
calculated  by  dividing  the  difference  in  encoder  counts  by  the  sampling  time  interval. 
Each  encoder  generates  4000  counts  per  revolution  and  the  servo  loop  runs  at  1500 
Hz  so  the  velocity  information  obtained  from  these  differences  is  quite  satisfactory. 
Because  of  the  limited  resolution  of  the  analog-to-digital  converter,  this  differenced 
velocity  is  more  accurate  than  the  tachometer  signal. 

The  proportional  and  derivative  feedback  gains  are  implemented  in  microcode 
on  the  microprocessors.  Since  motor  position  is  obtained  in  encoder  counts  and 
the  actual  velocity  command  to  the  amplifiers  is  calculated  as  an  equivalent  12- 
bit  count  to  the  digital-to-anaJog  converter,  the  values  for  Kp  and  used  in  the 
equivalent  analog  representation  of  Figure  6.3  differ  from  the  digital  counts  Kpd 
and  A'vd  specified  in  the  computer.  The  relationships  between  these  two  sets  of 
parameters  are  given  by: 


(6.2) 

A  vd^enc  ^  D i  A  ^samp 

(6.3) 

where 

h\nc  =  4000  counts /27r  rad 
.4  =  lOV/2047  counts 
T,arrp  -  0.667  msec. 

The  digital  feedback  gains  used  during  actual  tests  were  Kpj  =  0.9  and  =  7.5. 

The  response  of  the  .X-axis  to  a  step  change  in  position  setpoint  of  56.55  radians 
on  the  actual  robot  is  shown  in  Figure  6.4.  The  velocity  is  shown  in  (a),  the  motor 
current  in  (b),  the  motor  position  in  (c),  and  the  motor  velocity  in  (d).  .A  number  of 
signals  saturate  during  this  step  response.  The  velocity  command  voltage  saturates 
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Figure  6.4:  .Actual  X-Axis  Response  to  .56.55  rad  Step  Setpoint:  (c)  Motor  Position 


(d)  Motor  Velocity. 
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Table  G.  I 


Actuator  -Model  Simulation  Parameters 


^ruch  =  0.024  Volt  —  sec/ rad 
J.v  =  2.053  X  10-^  kg  -  m- 
Jy  =  2.780  X  10“^  kg  - 
B  =  0.0055  Nm  —  sec 
rf„,  =  0.7  Nm 


hpre  —  -1.3 
^amp  =  -3.8 
=  0.333 
L  =  0.0158  h 
R  =  2Q 

Kx  -  0.5  Nm/amp 
Kb  —  0.5  Volt  —  sec/ rad 


at  :rl0  volts,  the  current  command  at  ±5.4  volts.  Maximum  motor  voltage  is  150 
volts  and  the  current  saturates  at  8  amps.  This  response  served  as  the  basis  for 
evaluating  the  simulation  model. 

Parameters  for  the  simulation  model  representing  the  robot  under  position  con¬ 
trol  were  determined  from  measurements  and  specifications.  Values  for  these  pa¬ 
rameters  are  given  in  Table  6.1.  Some  of  these  values,  in  particular  Kamp  and  A\., 
had  to  be  adjusted  in  order  to  make  simulated  transient  response  agree  with  the 
actual  data  of  Figure  6.4. 

When  saturation  is  included  in  the  robot  simulation  model,  the  simulated  step 
response  for  the  same  56.55  radian  step  is  shown  in  Figure  6.5.  Notice  that  the  model 
captures  the  same  dynamic  behavior  that  the  actual  system  exhibits.  While  the 
system  is  accelerating,  motor  voltage  is  saturated.  .As  motor  speed  increases,  so  does 
the  back  emf  voltage.  More  motor  voltage  goes  into  overcoming  the  back  emf  losses 
so  that  motor  current  begins  to  decrease.  This  reduces  the  rate  of  acceleration 
and  eventually  motor  velocity  reaches  a  maximum  value  near  200  rad/ sec.  The 
simulation  model  predicts  this  behavior  quite  well,  and  therefore  will  serve  as  a 
good  testbed  for  trying  out  various  inputs  before  implementing  them  on  the  actual 
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Figure  6.5:  Simulated  X-Axis  Response  to  56.55  rad  Step  Setpoint:  (c)  Motor 
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6.3:  Structural  Resonance  Model: 


hardware. 


6.3  Structural  Resonance  Model: 


Before  the  simulation  model  can  be  used  to  predict  the  vibration  response,  it  must 


be  modified  to  include  the  structural  resonance  of  the  lowest  mode  of  vibration.  We 


will  concentrate  on  those  modes  which  have  dominant  motion  in  the  X-direction. 


Both  open-loop  and  closed-loop  determinations  of  the  structural  natural  fre¬ 


quencies  were  made.  These  were  based  on  the  extensive  work  done  by  Garcia  61; 
to  determine  the  mode  shapes  and  frequencies  of  the  MIT  Robot.  A  piezoelectric 
accelerometer  (B&:K  4371)  was  mounted  at  the  bottom  of  the  Z-axis  measuring  in 
the  positive  X-direction.  Open-loop  measurements  were  performed  using  a  Struc¬ 
tural  Dynamics  .Analyzer  (HP  5423.4).  random  noise  signal  was  used  as  a  velocity 
command  input  directly  to  the  X-axis  antplifier.  .Acceleration  was  measured  using 
the  accelerometer  and  a  charge  amplifier  (B&K  2651).  The  analyzer  was  used  to  'de¬ 
termine  the  transfer  function  between  random  noise  input  and  acceleration  output. 
The  magnitude  of  this  transfer  function  is  shown  in  Figure  6.6(a),  for  the  X-a.xis 
located  in  front  (—X)  and  the  Y-axis  midway  in  its  total  travel. 

Closed-loop  measurements  with  the  proportional-derivative  controller  of  Figure 
6.3  were  performed  by  moving  the  X-axis  over  a  distance  of  0.23  m  (9  in.)  corre¬ 
sponding  to  the  step  setpoint  of  56.55  rad.  The  Y-axis  was  in  the  same  position  as 
before.  The  analyzer  was  used  to  record  the  residual  acceleration  signal  after  the 
final  position  was  reached  (in  0.5  sec.).  The  magnitude  of  the  Fourier  transform  of 


this  residual  vibration  is  shown  in  Figure  6.6(b). 


These  two  measurements  indicate  that  modes  with  dominant  .X-direction  occur  at 


12,  40,  51,  63,  70,  76,  and  83  Hz.  Most  of  these  modes  show  up  in  both  open-loop  and 
closed-loop  measurements.  The  12  Hz  mode  in  particular  does  not  appear  to  change 


frequency  despite  the  addition  of  the  feedback  controller.  Since  this  mode  dominates 
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Figure  6.6;  Robot  Natural  Frequencies:  (a)  Open-loop  Transfer  Function,  (b)  Fre¬ 
quency  Spectrum  of  Closed-Loop  Residual  Response. 
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Figure  6.7:  Resonant  Model  of  First  Mode  of  Robot. 

the  closed-loop  residual  vibration,  we  will  use  that  frequency  in  a  structural  model 
of  the  robot.  Concentrating  on  a  single  mode  simplifies  the  modeling  ahd  still  allows 
us  to  test  the  effectiveness  of  the  shaped  inputs  on  a  realistic  representation  of  an 
actual  system. 

The  detailed  modal  analysis  of  the  robot  performed  by  Garcia  61  showed  that 
the  12  Hz  mode  consists  of  the  entire  robot  structure  rocking  back  and  forth  on  the 
floor  in  the  X-direction.  This  requires  a  slightly  different  resonant  model  than  the 
two-mass  model  used  so  far.  This  new  model  is  represented  in  schematic  form  in 
Figure  6.7.  The  spring  ki,  and  damper  bi,  represent  the  stiffness  and  dissipation  of 
the  floor,  while  mi,  represents  the  mass  of  the  nonmoving  robot  structure.  Notice  in 
particular  the  reaction  force  /  due  to  the  motor  pushing  against  the  base  in  order  to 
move  the  axis  nza.  Damping  6^  and  friction  is  assumed  to  exist  between  the  moving 
axis  and  the  nonmoving  structure. 

This  resonant  model  can  be  inserted  into  the  block  diagram  of  Figure  6.2  with 
the  addition  of  a  transmission  ratio  r  converting  rotation  to  translation  in  the  ball 
screw.  The  transfer  function  model  to  be  inserted  in  place  of  the  rigid-body  model 
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Figure  6.8;  Block  Diagram  Model  of  Structural  Resonance, 
is  shown  in  Figure  6.8,  where 

=  J 

and 

The  measured  motor  velocity  u;  actually  represents  the  relative  velocity  between 
the  axis  and  the  robot  base.  The  acceleration  as  measured  by  the  accelerometer  is 
the  absolute  acceleration  of  the  axis.  Thus,  the  simulations  give  the  second  derivative 
of  i/a  as  the  accelerometer  output.  Values  for  the  additioned  simulation  parameters 
are  given  in  Table  6.2. 

Including  the  resonant  model  in  the  simulation  gives  the  results  shown  in  Figure 
6.9  for  a  step  setpoint  of  56.55  rad.  The  motor  current  is  given  in  (a)  and  the 
absolute  acceleration  of  the  axis  in  (b).  This  compares  with  the  actual  X-axis  step 
response  of  Figure  6.10.  The  biggest  difference  in  the  responses  is  the  oscillation  of 
the  current  signal  at  the  natural  frequency  in  the  simulation.  This  does  not  occur  in 
the  actueil  system  response.  This  suggests  that  the  encoder  mounted  on  the  motor 
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Table  6.2 

Resonant  Model  Simulation  Parameters 


cannot  adequately  measure  the  vibration  of  the  structure  for  the  controller  to  damp 
it  out.  This  also  explains  why  the  open-loop  and  closed-loop  natural  frequencies 
are  nearly  the  sAme.  However,  the  resonant  model  is  still  useful  in  evaluating  the 
performance  of  the  system  to  the  proposed  shaped  inputs. 

6.4  The  Effect  of  Actuator  Saturation: 

In  order  to  test  the  versine  inputs  in  the  simulation  model,  the  closed-loop  controller 
of  Figure  6  ■3  miis  t  be  changed  slightly.  In  this  case,  only  the  position  reference 
is  used  as  the  signal  to  be  followed.  The  velocity  is  simply  compared  with  zero. 
However,  in  order  to  ensure  good  reference  following,  the  velocity  of  the  reference 
trajectory  should  be  included.  This  arrangement  is  shown  in  Figure  6.11,  with  both 
9, ft  and  its  time  derivative  being  used  as  reference  inputs. 

The  reference  position  trajectory  9„t  is  again  determined  by  doubly  integrating 
the  shaped  force  (torque)  profile  through  an  inertia.  Thus,  9,ft(s)  =  t{s)IJ3^. 
Since  the  velocity  saturates  near  200  rad/sec  and  the  torque  saturates  near  4  Nm  (8 
amps),  the  torque  profile  must  be  chosen  to  remain  within  these  limits.  Because  the 
shaped  inputs  are  constructed  assuming  no  friction  or  damping  to  ground,  additional 
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Figure  6.11:  Closed-Loop  Controller  Including  Reference  Velocity. 


torque  must  be  available  beyond  the  maximum  torque  used  in  the  shaped  profile. 
This  can  be  accomplished  by  using  a  maximum  torque  r,  for  the  shaped  input  of 
2.9  Nm  and  a  peak  velocity  ujp  of  189  rad/sec.  For  these  values,  the  dimensionless 
parameter  u/nTnl'Iv  =  (u;„/2T)Jwp/r,.  for  the  12  Hz  mode  has  a  value  of  1.44.  The 
shaped  torque  profile  tuned  to  this  parameter  is  shown  in  Figure  6.12  along  with 
its  simulated  response.  The  reference  velocity  trajectory  specified  by  the  torque 
waveform  of  Figure  6.12(a)  is  shown  in  Figure  6.12(b).  Simulated  motor  current, 
motor  velocity,  and  endpoint  acceleration  are  shown  in  Figure  6.12(c),  (d),  and  (e). 
A  considerable  amount  of  vibration  remains  despite  the  use  of  a  shaped  versine 
input. 

.4  comparison  of  the  desired  and  actual  velocity  profiles  will  help  explain  this 
response.  As  Figures  6.12  (b)  and  (d)  make  clear,  the  actual  simulated  velocity  can¬ 
not  keep  up  with  the  reference  velocity  profile.  Even  though  the  system  does  finally 
reach  the  desired  peak  velocity,  it  does  so  more  slowly  than  specified.  A  look  at  the 
current  waveform  of  Figure  6.r2(c)  shows  a  noticeable  drop-off  in  current  in  exactly 
the  same  region  where  velocity  begins  to  lag  behind.  This  current  saturation  was 
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Figure  6.12;  Simulated  X-.4xis  Response  to  Versine  Input  with  r,  =  2.9  Nm  and 
u!p  —  189  rad/sec:  (a)  Reference  Torque  V*^aveform. 

also  observed  for  the  step  response  of  Figures  6.4  and  6.5.  Basically,  the  saturation 
in  the  amplifier  prevents  the  system  from  following  the  specified  input  waveform. 
As  a  result,  the  response  behaves  differently  from  the  desired  response  and  leads  to 
residual  vibration. 

This  test  highlights  the  importance  of  specifying  an  input  waveform  which  will 
not  cause  the  amplifier  to  saturate.  Once  saturation  does  take  place,  some  residual 
vibration  is  to  be  expected  even  when  properly  shaped  inputs  have  been  specified. 
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Figure  6.12:  Simulated  X-Axis  Response  to  Versine  Input  with  =  2.9  Nm  and 
jjp  =  189  rad/sec:  (b)  Reference  Velocity  Trajectory  (c)  Motor  Current. 
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6.5  Development  of  Nonsaturating  Velocity  Pro¬ 
files: 

As  the  previous  section  makes  clear,  amplifier  saturation  may  prevent  the  shaped 
inputs  from  minimizing  residual  vibration.  Even  though  the  current  waveform  never 
exceeds  8  amps,  it  still  saturates  when  sufficient  motor  velocity  is  reached.  .A  new 
velocity  profile  must  therefore  be  developed  that  takes  this  velocity-dependent  se^ 
uration  into  account. 

The  parameters  of  the  velocity  profile  that  are  to  be  determined  are  acceleration 
and  peak  velocity.  The  acceleration  is  proportional  to  the  peak  amplitude  of  the 
shaped  torque  profile  used.  There  are  two  different  saturation  phenomena  that 
should  be  avoided.  First,  the  maximum  specified  current  should  never  exceed  8 
amps.  Second,  the  specified  current  should  never  exceed  the  level  that  is  achievable 
with  increasing  back  emf  losses. 

Incorporating  these  constraints  into  a  deterniination  of  velocity  profile  parame¬ 
ters  requires  some  assumptions  on  the  shape  of  the  reference  input  torque  waveform. 
This  reference  input  ignores  friction  so  its  peak  torque  level  must  be  low  enough  that 
when  the  controller  calls  for  extra  torque  to  compensate  for  damping  and  friction, 
the  totai  torque  will  be  within  saturation  levels.  Since  viscous  damping  torque  is 
proportional  to  velocity,  we  must  determine  the  correspondence  between  torque  and 
velocity  at  the  critical  points  when  either  reference  torque  or  velocity  are  at  max¬ 
imum  values.  Since  the  reference  torque  profile  is  a  complicated  function  of  time 
that  also  depends  on  the  parameters  for  which  it  was  tuned,  relating  torque  and 
velocity  analyticrdly  can  be  difficult.  Instead,  we  will  make  some  conservative  as¬ 
sumptions  that  should  apply  for  all  inputs  to  be  considered.  We  will  assume  that 
the  reference  torque  near  maximum  velocity  ^’p  is  1/2  of  its  peak  value  and  that 
the  peak  reference  torque  occurs  for  a  velocity  as  high  as  2ujp/3. 

Keeping  these  assumptions  in  mind,  we  will  proceed  by  specifying  the  constraints 
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on  the  reference  torque  in  order  to  avoid  amplifier  saturation.  With  current  satu¬ 
rating  at  8  amps,  the  peak  motor  torque  that  can  be  generated  is  4  Nm.  Thus,  peak 
reference  torque  plus  the  torque  required  to  overcome  friction  and  damping  must 
never  exceed  this  value: 

2 

7-p  -1-  -Bujp  -t-  <  4  Nm  (6.6) 

In  addition,  the  torque  required  at  maximum  velocity  should  not  exceed  the  limit 
imposed  by  back  emf  losses.  This  current  limit  occurs  as  a  result  of  the  saturation 
of  the  current  command  V,,.  Steady-state  current  i  can  be  expressed  in  terms  of 
and  a;  from  Figure  6.2  as  follows; 


^amp^c  B  qUJ 
B  4“  ^  amp  cur 


Thus,  the  second  torque  constraint  at  peak  velocity  wjp  is  given  by 


,.y  4“  BfMp  4“  T J Bj* 


Burnp^c  B  QuJp 

R  4“  K-ampRcur 


(6.7) 


(6.8) 


These  constraints  can  be  e.xpressed  in  terms  of  a  linearized  acceleration  a,  defined 
as 


a  =  ^p/Tp 


(6.9) 


where  Tp  is  the  time  required  for  the  versine  input  to  reach  peak  velocity  u,’p.  Peak 
reference  torque  is  related  to  this  acceleration  by  the  expression; 


=  r\rJa. 


(6.10) 


where  F v  is  the  time-scale  factor  associated  with  the  versine  input  defined  by  (.5.10). 
Thus,  the  constraint  expressed  by  (6.8)  using  the  equality  establishes  a  relationship 
between  a  and  ^p  that  will  just  avoid  current  saturation.  This  relationship  can  be 
rewritten  as 

a  =  Cl  -  C2^p  (6.11) 


where  ci  and  Ci  are  constants  resulting  from  the  substitution  of  (6.10)  into  (6.8). 
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To  determine  the  best  values  of  a  and  u/p  for  fastest  response  without  saturation, 
we  will  try  to  minimize  the  total  move  time  Tf  given  by 


Tf  =  IT,  + 


(6.12) 


where  9  is  the  desired  angular  displacement.  Our  goal  is  to  express  Tj  in  terms  of  9 
and  only,  and  then  to  determine  that  velocity  which  minimizes  Tf  for  a,  given  0. 
This  can  be  done  by  expressing  Tp  as  u^p/Q  from  (6.9)  and  substituting  for  a  from 
(6.11).  The  result  is  the  time  T/  expressed  as  a  function  of  a;p.  For  9  =  -56. .5.5  rad, 
this  function  is  plotted  in  Figure  6.13(a).  .\  value  of  1.75  was  assumed  for  Fv^  to 
represent  a  typical  versine  function.  With  the  help  of  expressions  (6.10)  and  (6.11), 
Tf  can  also  be  plotted  as  a  function  of  r^,  as  shown  in  Figure  6.13(b).  The  constraint 
of  (6.6)  was  included  in  these  figures  to  ensure  that  the  4  Nm  saturation  torque  is 
not  exceeded.  This  limit  causes  the  discontinuities  in  these  curves. 

For  the  rotation  of  56.55  rad,  minimum  Tf  occurs  for  a  peak  velocity  of  roughly 
145  rad/sec  and  a  peak  reference  torque  of  about  2.75  Nm.  Since  the  shaped  torque 
profile  calls  for  half  peak  torque  at  a  speed  just  below  peak  velocity  rather  than 
at  peak  velocity  as  was  assumed  in  this  development,  we  will  use  the  parameters 

=  150  rad; sec  and  =  2.75  Nm  to  generate  versine  inputs  for  the  rotation  of 
56.55  radians.  This  corresponds  to  an  axis  velocity  of  0.6  m/s  (2.0  ft/s)  and  an 
accelerating  force  of  688  N  (155  Ibf).  For  larger  moves,  the  same  approach  can  be 
used.  In  general,  as  move  distance  increases,  more  time  is  spent  at  peak  velocity. 
Thus,  the  peak  torque  which  will  minimize  move  time  will  be  lower  and  peak  velocity 
will  be  higher  to  minimize  the  time  spent  at  constant  velocity. 

For  the  parameters  selected,  the  versine  input  for  the  single-resonance  model  of 
Figure  6.7  gives  the  simulated  response  shown  in  Figure  6.14.  Notice  that  this  time 
the  residual  vibration,  shown  in  Fig.  6.14(e),  has  indeed  been  eliminated,  in  part 
because  the  amplifier  current  no  longer  saturates. 

With  these  values  for  r,.  and  a»p  and  the  known  X-axis  inertia,  the  value  for 
Tr  =  J.jjp/Tr  becomes  0.112  sec.  We  can  now  determine  an  appropriate  versine 
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Figure  6.14;  Simulated  X-Axis  Response  to  Versine  Input  with  r,  =  2,75  Nm  and 
=  150  rad/sec:  (a)  Reference  Torque  Waveform. 

input  using  this  time  value  to  normalize  the  natural  frequencies  for  the  actual  robot. 
This  input  profile  is  constructed  to  minimize  spectral  magnitude  at  four  frequencies 
( 12,  40,  70,  and  84  Hz),  with  a  ±20%  band  about  12  Hz  and  ±10%  band  about  the 
others.  Such  a  shaped  input  is  shown  in  Figure  6.15(a),  with  its  frequency  spectrum 
in  (b).  This  input  was  used  to  perform  tests  on  the  robot  which  are  discussed  in 
Chapter  7. 

6.6  Closure: 

This  chapter  developed  a  detailed  model  of  the  MIT  Cartesian  Robot  in  preparation 
for  performing  experiments.  This  model  includes  the  effects  of  actuator  saturation 
and  the  first  structural  resonance  of  the  robot.  Simulation  results  with  the  versine 
input  indicate  the  importance  of  avoiding  current  saturation  to  ensure  that  resid- 
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Figure  6.14:  Simulated  X-Axii  Response  to  Versine  Input  with  =  2.75  Nm  and 
*»p  =  150  rad/sec:  (b)  Reference  Velocity  Trajectory  (c)  Motor  Current. 
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ual  vibration  is  indeed  minimized.  Parameters  for  the  velocity  profile  were  then 
determined  which  avoid  current  saturation  and  still  generate  fast  motion.  These 
parameters  were  used  to  construct  a  versine  input  to  run  the  .X-a.^is  on  the  actual 
robot.  E.xperimental  results  are  discussed  in  the  next  chapter. 


Experimental  Results 


Chapter  7 


7.1  Introduction: 

This  chapter  will  present  experimental  results  for  the  MIT  Cartesian  Robot  using 
the  versine  input  developed  in  Chapter  6.  These  responses  will  be  compared  with 
the  step  response  and  the  response  to  a  rectangular  pulse  input.  Robustness  to 
variation  in  nat-ir^I  frequency  will  be  illustrated  by  performing  tests  on  the  X-axis 
for  several  different  positions  of  the  Y-axis.  The  effect  of  modal  coupling  between 
axes  will  be  illustrated  by  generating  motion  in  Y  and  measuring  vibrations  in  X. 
.\n  advantage  of  the  shaped  versine  input  is  its  ability  to  avoid  the  excitation  of  any 
specified  natural  frequency,  including  modes  that  vibrate  in  directions  orthogonal 
to  the  motion  and  cannot  be  measured. 


7.2  Microprocessor  Implementation: 

Before  presenting  experimental  results,  we  will  describe  the  implementation  of  time- 
varying  setpoints  in  the  control  microprocessors.  Since  the  reference  signal  used 
by  the  controller  presented  in  Section  4.3  of  Chapter  4  is  generated  by  doubly 
integrating  the  shaped  force  profile,  it  represents  a  continuously-varying  function 
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of  time.  The  controller  as  configured  by  Benjamin  [75]  takes  a  constant  setpoint 
as  reference  to  be  followed.  This  generates  a  step  response  but  does  not  allow 
the  implementation  of  time-varying  setpoints.  Thus,  some  of  the  software  for  the 
microprocessors  must  be  changed. 

Since  the  microprocessors  are  connected  to  a  V'.\X  computer  (see  Figure  7.1),  the 
time-varying  setpoints  could  be  stored  in  the  V.4.X  and  sent  to  the  microprocessors 
at  each  time  step,  or  stored  directly  in  the  microprocessors.  Because  the  VAX  and 
the  micros  run  on  different  internal  clocks,  the  setpoints  are  stored  directly  in  the 
micros  to  ensure  that  the  correct  setpoint  is  synchronized  with  the  servo  time  step. 
Thus,  before  each  move,  a  file  of  setpoints  is  downloaded  to  memory  in  the  micros. 
These  setpoints  are  generated  by  doubly  integrating  the  desired  force  profile. 

To  read  these  setpoints  sequentially,  using  a  different  memory  location  at  each 
time  step,  the  framework  program  that  controls  the  operation  of  the  micros  must  be 

modified.  The  new  code,  in  Intel  8031  assembly  language,  is  g'iven  in  Appendix  C. 

« 

.A.t  the  start  of  the  move,  the  beginning  memory  location  is  read.  Then,  each  new 
time  step  increments  the  memory  location  to  read  the  next  setpoint,  and  so  on.  A 
'•ontrol  bit  is  used  to  signal  the  micros  to  use  a  time-varying  setpoint,  rather  than 
the  constant  step  setpoint. 

In  order  to  introduce  both  the  position  reference  and  the  velocity  reference  as 
called  for  by  the  controller  of  Chapter  4.  the  derivative  of  the  sequence  of  position 
setpoints  must  be  obtained.  This  is  easily  accomplished  by  computing  the  difference 
in  reference  setpoints  in  each  time  step.  This  difference  is  then  compared  with  the 
actual  differenced  velocity  and  the  resulting  velocity  error  and  position  reference  are 
used  in  the  PD  servo  loop  as  originally  configured  by  Benjamin. 


7.3  Experimental  Setup: 

In  all  of  the  tests  performed,  the  acceleration  was  measured  in  the  X-direction. 
A  B&K  4371  accelerometer  was  mounted  at  the  bottom  of  the  Z-axis  facing  the 
^X-direction.  The  accelerometer  signal  was  conditioned  by  a  B&K  2651  charge 
amplifier,  giving  an  output  of  0.1  volt  for  1  g  ( 10  m/s^)  of  acceleration.  Garcia's 
work  suggests  that  accelerations  on  the  order  of  1  g  are  to  be  expected  in  the 
transient  response.  Since  the  analog-to-digital  (.4/D)  converter  which  sends  this 
data  to  the  microprocessors  for  storage  has  a  range  of  ±10  V,  the  accelerometer 
signal  must  be  amplified.  Therefore,  an  Analog  Devices  AD521  chip  was  configured 
into  an  instrumentation  amplifier  with  a  gain  of  105. 

.All  data  taken  for  each  move  was  stored  on  the  micros  during  the  motion  and 
then  transferred  to  the  V.AX  for  analysis  and  plotting.  This  data  was  stored  in  the 
same  block  of  memory  as  that  containing  the  setppints,  writing  over  the  setpoints 
used  for  the  previous  tirne  step.  In  order  to  ensure  that  this  data  does  not  write 
over  any  setpoints  which  are  yet  to  be  used,  data  was  only  taken  every  other  servo 
time  step,  at  a  rate  of  750  Hz. 

In  order  to  avoid  aliasing  of  the  acceleration  signal  when  sampled  at  750  Hz. 
it  has  to  be  filtered  before  entering  the  A/D  converter.  To  retain  fidelity  of  the 
vibration  signal  up  to  100  Hz  but  effectively  remove  any  frequency  components 
above  the  Nyquist  frequency  of  375  Hz,  an  Ithaco  model  4112  low-pass  filter  was 
used.  Its  cut-off  frequency  was  set  at  160  Hz  to  sufficiently  attenuate  the  signal  at 
375  Hz. 

Because  of  the  limited  memory  on  board  the  micros,  the  acceleration  signal  was 
stored  on  the  Y-a.xis  micro,  while  the  current  signal  measured  by  the  amplifier  was 
stored  on  the  X-axis  micro,  along  with  the  encoder  position  and  the  amp  velocity 
command  signal  for  the  X-axis. 

The  residual  acceleration  signed  and  its  frequency  spectrum  were  measured  using 
an  HP  5423A  Structural  Dynamics  Analyzer.  The  accelerometer  output  was  sent  to 
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both  the  analyzer  and  the  micro  A  D  converter.  The  analyzer  was  triggered  as  soon 
as  motion  began,  with  a  sufficient  time  delay  to  start  taking  the  measurement  only 
when  motion  had  stopped.  In  this  way,  only  the  residual  vibration  was  measured. 

Before  acceptable  data  could  be  obtained,  an  additional  change  had  to  be  made 
in  the  amplifiers.  Initial  tests  using  a  nonsaturating  reference  input  showed  con¬ 
siderable  current  oscillation  during  the  constant  velocity  portion  of  the  move.  This 
oscillation  did  not  occur  for  the  saturating  step  input.  Perhaps  saturation  precluded 
this  oscillation  because  the  current  signal  was  kept  at  its  e.Ktreme  value. 

Since  the  current  oscillation  during  the  constant  velocity  phase  is  also  picked  up 
by  the  accelerometer,  it  tends  to  degrade  the  performance.  Further  tests  indicated 
that  this  oscillation  has  nothing  to  do  with  the  input  being  used.  In  fact,  the  preamp 


gains  were  originally  chosen  for  maximum  servo  stiffness  without  going  unstable 


(  Drlik  ,  74] ).  Thus,  the  amplifiers  were  only  marginally  stable.  To  solve  this  problem, 
resistor  RlOO  which  sets  the  preamp  gain  was  removed  from  the  X-axis  amplifier. 
Likewise,  resister  R83  was  removed  from  the  Y-axis  amplifier.  (These  resistors  are 
identified  in  schematics  given, by  Nussbaum  i73|).  Replacing  the  resistors  reduces 
the  inner  loop  servo  stiffness  of  the  amplifier  and  greatly  improves  the  current  signal 


at  constant  velocity. 


The  FORTH  commands  used  to  generate  motion  for  the  e.xperimental  tests  are 
summarized  in  .\ppendix  B.  These  FORTH  words  are  defined  in  .Appendix  D.  Once 
the  robot  had  completed  its  motion  and  data  had  been  stored,  the  data  was  copied 
from  the  micros  to  the  V.\X.  There,  the  numbers  were  converted  into  appropriate 
units  and  plotted.  These  results  are  described  in  the  ne.xt  section. 


7.4  Experimental  Tests  on  X-Axis: 


Wit  ii  the  Y  -axis  in  the  middle  of  its  workspace,  the  X-axis  was  moved  from  zero  to 
0.2.3  m  (9  in.)  in  the  — X-direction.  Three  types  of  reference  inputs  were  used:  a  step. 
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an  integrated  rectangular  pulse  input,  and  an  integrated  versine  input.  By  doubly 
integrating  the  rectangular  pulse  input  and  the  versine  input,  a  smooth  reference 
profile  is  achieved  that  the  system  can  follow.  Total  motor  rotation  during  this  move 
was  56. .55  rad.  The  results  for  a  step  reference  input  are  shown  in  Figure  7.2,  those 
for  the  integrated  rectangular  pulse  input  in  Figure  7.3,  and  those  for  the  integrated 
versine  input  in  Figure  7.4.  In  each  case,  the  current  signal  is  shown  in  (a),  the 
motor  position  in  (b/,  the  motor  velocity  in  (c),  and  the  endpoint  acceleration  in 
(d).  The  current  signal  is  nonzero  even  when  the  axis  has  reached  its  destination 
because  of  stiction  in  the  moving  elements. 

The  step  response  reaches  the  final  position  most  quickly  but  also  generates 
fhe  most  residual  vibration.  The  shaped  versine  force  input  with  reference  torque 
Tr  =  2.75  Nm  and  peak  velocity  ajp  =  150  rad/sec  takes  about  20%  longer,  but  it 
generates  much  lower  residual  vibration. 

The  rectangular  pulse  force  input  used  here  to  generate  a  smooth  reference  pro¬ 
file  for  comparison  with  the  versine  response  was  selected  to  have  the  same  move 
time  as  the  versine  input.  Its  peak  torque  therefore  is  less  than  2.75  Nm.  The 
reason  for  choosing  this  input,  rather  than  a  pulse  of  equivalent  peak  torque,  is  that 
the  parameters  r,  and  uip  chosen  for  the  versine  do  not  prevent  saturation  for  the 
rectangular  pulse  input.  Saturation  occurs  because  the  reference  acceleration  for  the 
rectangular  pulse  is  much  higher  than  for  the  versine  input.  Since  saturation  tends 
to  increase  residual  vibration,  the  rectangular  pulse  peak  torque  was  scaled  down  to 
1.31  Nm  to  make  total  move  time  equal  to  that  of  the  versine  input.  .A.s  the  results 
of  Figure  7.3  show,  the  use  of  a  smooth  reference  input  based  on  a  rectangular  pulse 
helps  compared  to  the  step  input,  but  it  still  generates  more  residucil  vibration  than 
the  versine  input. 

The  frequency  spectrum  of  the  residual  vibration  resulting  from  the  three  dif¬ 
ferent  inputs  are  shown  in  Figures  7.5,  7.6,  and  7.7.  Notice  that  the  integrated 
versine  reference  reduces  the  vibration  of  the  12  Hz  mode  by  20  db  compared  to  the 
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Table  7.1 

Residual  Endpoint  Motion  (mm) 


Step  Reference  : 

0.230 

Rectangular 

Pulse  Reference  : 

0.028 

Versine  Reference  : 

0.014 

step  reference  and  by  8  db  compared  to  the  integrated  rectangular  pulse  reference. 
Further  attenuation  of  the  12  Hz  mode  is  impossible  since  the  ambient  noise  in  the 
building  generates  the  remaining  e.x;citation.  Figure  7.8  shows  the  frequency  spec¬ 
trum  of  the  robot  excited  only  by  ambient  noise.  Notice  that  the  peak  at  12  Hz  is 
at  -30  db,  the  same  level  as  that  for  the  versine  input. 

The  versine  reference  also  reduces  the  residual  vibration  at  40  Hz,  compared  with 
either  the  step  or  the  rectangular  pulse  reference.  However,  modes  at  68  Hz  and 
75  Hz  remain  despite  the  low  excitation  energy  which  the  versine  function  has  at 
these  frequencies.  Perhaps  some  excitation  energy  from  lower  frequencies  is  e.xciting 
these  higher  modes  due  to  some  nonlinearities  in  the  robot  structure.  Regardless 
of  their  origin,  these  modes  contribute  only  0.5  micron  to  the  residual  amplitude. 
A  comparison  of  the  residual  vibration  at  the  endpoint  measured  in  mm  (rather 
than  acceleration  units)  for  the  three  inputs  is  shown  in  Table  7.1.  These  values 
were  determined  by  doubly  integrating  the  acceleration  amplitudes.  If  we  assume 
that  a  single  frequency  at  12  Hz  dominates,  then  the  amplitude  of  the  endpoint 
position  oscillations  can  be  approximated  by  dividing  the  acceleration  amplitudes 
by  the  square  of  the  frequency. 
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7.5  Robustness  to  Variation  in  Natural  Frequency 

Garcia  6l|  determined  that  the  robot  modes  with  dominant  X-direction  change 
natural  frequency  by  10%  depending  on  the  location  of  the  Y-axis.  Therefore,  tests 
were  performed  with  the  Y-axis  in  the  extreme  left  ( Y  =  0)  and  extreme  right  ( ^Y) 
positions  to  see  this  shift  in  natural  frequency  and  to  determine  whether  the  same 
versine  input  will  work  equally  well  for  ail  cases. 

Results  for  X-axis  motion  with  the  Y-axis  to  the  left  are  shown  in  Figures  7.9 
to  7.11.  and  with  the  Y-axis  to  the  right  are  shown  in  Figures  7.12  to  7.14.  The 
same  three  reference  inputs  are  used  as  before.  The  acceleration  signal  is  shown  in 
(a)  and  the  frequency  spectrum  of  the  residual  vibration  in  (b).  The  two  different 
step  responses  show  a  shift  in  the  first  natural  frequency  from  11.5  Hz  when  the 
Y-axis  is  to  the  left  to  13  Hz  when  the  Y-axis  is  to  the  right.  Despite  this  variation 
in  natural  frequency  of  roughly  10%,  thp  same  versine  input  effectively  reduces  the 
residual  vibration  at  that  mode  in  both  cases.  In  fact,  the  attenuation  is  the  same  as 
it  was  previously  for  the  Y-a-xis  in  the  middle,  the  position  for  which  the  waveform 
was  originally  specified. 

One  additional  phenomenon  shows  up  in  the  frequency  spectrum  when  the  Y- 
axis  is  to  the  right.  For  that  configuration,  an  additional  mode  at  33  Hz  appears 
that  did  not  appear  when  Y  was  in  the  middle.  The  mode  shapes  measured  by 
Garcia  [61]  indicate  that  the  33  Hz  mode  consists  of  the  top  frame  twisting  about 
the  middle  (Figure  7.15).  Therefore,  this  mode  is  difficult  to  detect  in  X  when  Y 
is  in  the  middle,  but  rather  easy  to  detect  when  Y  is  to  the  right.  A  new  versine 
input  can  be  developed  which  reduces  the  energy  at  33  Hz.  This  new  time  function 
is  shown  in  Figure  7.16(a),  with  its  spectrum  in  (b).  The  response  of  the  X-axis 
to  this  input  with  the  Y-axis  to  the  right  is  shown  in  Figure  7.17.  Notice  that  the 
residual  vibration  at  33  Hz  is  reduced  by  8  db  when  the  input  is  filtered  at  that 
frequency. 
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Figure  7.11:  X-.\xis  Response  to  a  Versine  Input  for  a  0.23  m  Move;  Y-Axis  Left 
(a)  Endpoint  .\cceleration  (b)  Frequency  Spectrum  of  Residual  Vibration. 
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FiKurf  7,l:J:  X-Axis  Response  to  a  Rectangular  Pulse  Input  fir  a  0.23  m  Move: 
V  Axis  Right:  (a)  Endpoint  .Acceleration  (b)  Frequency  Spectrum  of  Residual  Vi- 


b’:  Modal  Coupling  Between  Axes 


Figure  7.19:  X-.Axis  Response  to  Y-Axis  Motion  of  0.2  m  using  a  Rectangular 
Pulse  Input:  (a)  Endpoint  .Acceleration  in  X  (b)  Frequency  Spectrum  of  Residual 
Vibration  in  X. 


Time- Varying  Na-tuml  Frequencies: 


reduces  excitation  of  this  mode  by  8  db.  Thus,  even  when  the  vibration  cannot  be 
measured  in  the  axis  of  motion,  the  shaped  inputs  can  avoid  excitation  of  vibration 
occurring  in  orthogonal  directions  to  the  motion. 

7.7  Time- Varying  Natural  Frequencies: 

If  both  the  X  and  Y  axes  are  moved  using  the  versine  inputs,  then  the  variation  in 
Y-position  will  continuously  alter  the  natural  frequencies  which  would  be  measured 
statically  at  each  succeeding  Y-position.  Such  a  test  would  determine  whether 
the  shaped  inputs  can  reduce  residual  vibration  for  dynamically  varying  natural 
frequencies.  The  acceleration  in  the  X-direction  when  moving  the  X-axis  a  distance 
of  0  .23  m  (9  in.)  and  the  Y-a.xis  a  distance  of  0.20  m  (8  in.)  is  shown  in  Figure  7.21. 
The  residual  vibration  at  12  Hz  has  again  been  reduced  to  the  ambient  level  of  —30 
db  as  before.  Thus  despite  the  dynamic  variation  in  resonant  characteristics  during 
the  move,  the  versine  input  is  still  capable  of  attenuating  the  residual  vibration. 


7.8  Discussion; 

The  shaped  versine  reference  inputs  were  tested  on  the  MIT  Cartesian  Robot  to 
determine  how  effective  they  are  at  reducing  residual  vibration  under  actual  condi¬ 
tions.  When  moving  in  a  single  direction,  the  versine  input  is  capable  of  bringing 
the  residual  vibration  down  to  the  level  e.xisting  only  with  ambient  noise.  This  holds 
true  even  when  the  location  of  the  Y-axis  is  changed  and  the  natural  frequencies 


Running  the  .X-a.xis  for  different  static  positions  of  the  Y-a.xis  gives  the  same 
attenuation  of  residual  vibration.  .And  when  both  a.xes  are  moved  simultaneously, 
causing  a  dynamic  variation  in  natural  frequencies,  residual  vibration  still  remains 
low.  Finally,  for  modes  which  can  be  excited  by  motion  in  an  axis  orthogonal 
to  the  dominant  vibration,  the  use  of  shaped  inputs  can  significantly  reduce  such 
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Conclusions  and  Future  Work 


Chapter  8 


8.1  Conclusions: 

Experimental  tests  done  on  the  MIT  Cartesian  Robot  indicate  the  effectiveness  of 
shaping  inputs  to  generate  motion  with  minimum  residual  vibration.  Such  inputs 
allow  the  use  of  a  simple  PD  controUet  to  achieve  accurate  position  without  the 
need  for  complex  controllers  to  damp  out  vibration  during  motion.  However,  this 
technique  does  not  preclude  the  use  of  a  more  sophisticated  controller  to  suppress 
vibration.  The  shaped  inputs  will  always  improve  the  residual  vibration  response 
generated  by  the  motion,  especially  in  cases  when  optimal  regulators  cannot  provide 
adequate  vibration  suppression. 

This  approach  is  especially  effective  when  dealing  with  complex  three-dimensional 
structures  with  mode  shapes  in  directions  other  than  the  motion  direction.  For  such 
systems,  the  modes  in  the  non-motion  direction  are  only  weakly  coupled  to  the 
dynamics  in  the  motion  direction.  .As  a  result,  these  modes  cannot  be  sufficiently 
compensated,  and  they  will  exhibit  considerable  off-a.xis  vibration  if  lightly  damped. 
These  vibrations  can  be  reduced  during  motion  using  shaped  reference  inputs  tuned 
to  the  off-a.xis  natural  frequencies. 

Shaped  force  inputs  were  developed  as  sums  of  ramped  sinusoid  harmonics  by 
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picking  the  coefficients  to  minimize  excitation  over  a  range  of  natural  frequencies. 
This  allows  for  uncertainties  in  the  determination  of  the  natural  frequencies  and 
dynamic  variation  in  natural  frequency  during  motion.  .An  additional  set  of  inputs 
was  developed  using  versine  inputs  to  permit  motion  of  constant  speed  for  systems 
which  are  velocity-limited. 

Shaped  inputs  were  constructed  on  the  assumption  that  the  system  to  be  con¬ 
trolled  has  no  damping  or  friction.  This  simplifies  the  determination  of  coefficients 
for  these  functions.  The  presence  of  modal  damping  does  reduce  the  effectiveness 
of  the  inputs  but  only  near  the  limits  of  the  frequency  band  where  spectral  energy 
has  been  minimized.  This  effect  can  be  ignored  for  lightly-damped  systems. 

The  presence  of  friction  can  easily  be  compensated  for  when  these  shaped  force 
inputs  are  incorporated  into  a  closed-loop  feedback  system.  All  that  is  required 
is  that  the  shaped  force  profile  be  converted  into  a  shaped  position  reference  by 
double  integration.  The  feedback  loop  compensates  for  friction  without  altering  the 
vibration-reducing  properties  of  the  shaped  inputs. 

Despite  these  advantages,  there  are  a  number  of  drawbacks  to  this  method. 
While  conventional  controllers  only  require  a  step  reference,  these  inputs  require  a 
series  of  time- varying  reference  setpoints  which  must  be  recomputed  for  each  move 
distance.  This  is  not  a  problem,  since  trajectory  controllers  already  compute  appro¬ 
priate  trajectories  to  achieve  a  desired  move.  But  it  does  increase  the  computational 
and  storage  requirements  of  the  controller. 

A  more  severe  disadvantage  is  the  requirement  that  the  actuator  never  saturate 
during  the  motion.  In  order  to  ensure  that  residual  vibration  is  minimized,  the 
actual  response  must  closely  follow  the  response  called  for  by  the  shaped  reference 
input.  If  the  actuator  saturates,  actual  response  lags  behind  and  more  residual 
vibration  occurs.  To  ensure  that  no  saturation  occurs,  the  forces  used  for  the  motion 
must  be  reduced  until  the  entire  force  profile  fits  within  the  saturation  limits.  This 
significantly  increases  the  time  needed  to  complete  the  move  using  shaped  inputs 
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rather  than  a  step  reference.  However,  settling  time  due  to  residual  vibration  has 
been  greatly  reduced. 

8.2  Future  Work: 

Several  additional  studies  are  motivated  by  this  work.  First  of  all,  it  would  be  useful 
to  investigate  the  use  of  shaped  inputs  for  large  variations  in  natural  frequency,  such 
as  occur  when  the  robot  configuration  changes  significantly  (e.g.  PUM.\  Robot)  jt 
when  picking  up  a  heavy  workpiece. 

.\  new  set  of  inputs  could  be  developed  that  compute  coefficients  to  take  into 
account  modal  damping  for  moderately-damped  systems. 

.\n  entirely  new  set  of  functions  could  be  developed  that  are  based  on  more 
realistic  assumptions  about  the  allowable  force  profile.  The  actual  motor  torque 
for  a  typical  amplifier  saturates  as  a  function  of  velocity  rather  than  saturating  at 
a  constant,  limit.  It  would  be  useful  to  use  more  complicated  saturation  profiles 
than  a  square  wave  or  a  rectangular  pulse  in  developing  shaped  inputs  resembling 
these  profiles.  Such  inputs  could  also  be  constructed  to  include  the  effects  of  friction 
and  damping  to  ground.  This  would  ensure  that  these  inputs  lead  to  actual  torque 
profiles  which  maximally  utilize  the  available  torque  without  saturating. 

Because  feedback  plays  an  important  role  in  determining  the  actual  torque  pro¬ 
file.  it  would  be  interesting  to  evaluate  the  effect  of  this  feedback.  If  the  feedback 
signal  introduces  energy  at  natural  frequencies  which  have  been  filtered  out  of  the 
shaped  input,  then  considerably  more  residual  vibration  will  oc'ur.  It  would  be 
useful  to  study  the  interaction  between  feedback  and  the  shaped  inputs  and  deter¬ 
mine  whether  different  feedback  compensators  would  improve  performance.  Perhaps 
the  use  of  acceleration  feedback,  either  from  the  motor  or  from  an  accelerometer 
mounted  at  the  end  point,  would  improve  feedback  compensation. 

It  would  also  be  useful  to  evaluate  the  effect  of  actuator  bandwidth  on  the 
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residual  vibration  attenuation  of  shaped  inputs  used  in  closed-loop  systems. 

These  additional  studies  would  answer  further  questions  concerning  the  use  of 
shaped  inputs  for  generating  motion  in  physical  systems.  These  inputs  have  already 
been  shown  to  reduce  residual  vibration  for  motion  of  a  Cartesian  Robot.  With 
additional  studies,  inputs  shaped  to  achieve  minimum  residual  vibration  and  mini¬ 
mum  move  time  may  become  an  important  element  to  control  the  vibration  of  actual 
dynamic  systems. 
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Chapter  2  presented  a  direct  relationship  between  residual  acceleration  ampli- 
tude  of  a  two-mass  system  and  the  frequency  spectrum  of  the  input  forcing  function 
used  to  generate  the  motion.  Since  this  result  applies  for  any  input  function,  it 
should  also  apply  to  the  bang-bang  function  developed  in  my  Master’s  Thesis  [55]. 
The  bang-bang  function  is  a  generalization  of  a  square  wave  forcing  function  that 
always  produces  peak  force  and  switches  between  positive  and  negative  levels  a  given 
number  of  times.  This  input  function  is  known  to  give  time-optimal  response. 

For  the  undamped  two-mass  system  model  of  Figure  2.3,  the  appropriate  bang- 
bang  function  consists  of  three  switches,  as  shown  in  Figure  A.l.  The  first  and  third 
switches,  occurring  at  times  ti  and  ^3  respectively,  are  symmetric  about  the  second 
switch  at  t2,  which  happens  halfway  into  the  move.  The  input  is  turned  off  at  the 
final  time  T/.  The  switch  times  ti,  ^2?  and  satisfy  the  following  expressions: 


1  —  2cosu;,,ti  -H  2cosu;„f2  —  2cosu;„f3  -I-  cosuJnTf  =  0 


«2  =  T//2 


(A.2) 
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Figure  A.l:  Three-Switch  Bang- Bang  Forcing  Function. 


Making  the  appropriate  substitutions,  can  be  simplif’ed  to 


^nTf 
COS  —— — 


1  cos 


n  (  h 


=  0. 


:a.4) 


This  expression  must  be  satisfied  by  and  T/  in  order  to  ensure  zero  residual 
vibration  for  the  two-mass  system. 

The  frequency  spectrum  of  the  three-switch  bang-bang  function  can  be  deter¬ 
mined  by  taking  the  Fourier  transform  as  follows; 

T 

F{^)  =  [  '  (A.5) 

Jo 

When  the  required  integration  is  performed,  the  frequency  spectrum  can  be  repre¬ 
sented  as 

!F(u;)|  =  —  !cos  — -  -  2  cos  a;  (  ^  —  ti )  +  l!  •  ( .A.6 ) 

u;  I  2  V  2  /  I 

.A,t  the  frequency  corresponding  to  the  system  natural  frequency  spectral  mag- 
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nitude  is  given  ny 


2  F  !  ^riTf  I  ^  f  \ 

F(u)n)\  =  —  icos  — - - 2cosu;„  —  -  ^l  -  1: 

2  V  2  / 


Substituting  the  expression  (A. 4)  into  (A. 7)  gives  the  final  result: 


!f(-'n)|  =0 


i  hus,  the  bang-bang  function  developed  to  eliminate  residual  vibration  can  be  shown 


to  have  a  frequency  spectrum  having  no  energy  at  the  natural  frequency.  This  is 
consistent  with  the  relationship  (2.13)  derived  in  Chapter  2. 

Since  the  bang-bang  function  contains  no  spectral  energy  at  the  system  natural 


frequency,  we  might  conclude  that  this  input  never  excites  the  system  at  its  natural 


frequency.  However,  the  sharp  transitions  in  the  forcing  function  suggest  that  many 
frequencies  are  excited  by  this  input,  including  the  system  natural  frequency.  In 
fact  wnat  is  happening  is  that  the  input  does  e.xcite  the  natural  frequency  in  the 
first  half  of  the  move  and  then  totally  reverses  the  phase  of  the  excited  vibration  in 


the  second  half  of  the  move  to  bring  the  system  to  rest  when  the  function  is  over. 


To  prove  this  assertion,  we  will  look  at  the  frequency  spectrum  of  the  first  and 


second  half  of  the  bang-bang  function  separately.  The  Fourier  transform  for  the  first 


half  of  the  move  is  given  by 


Jo  Juj 


(A.9) 


The  Fourier  transform  for  the  second  half  of  the  move  is  given  by 


JTf/2  JijJ 


(A.IO) 


Since  the  frequency  spectrum  depends  only  on  the  magnitude  of  expressions  (.\.9) 


and  (.A.IO).  we  will  restrict  attention  to  the  bracketed  quantities.  These  can  be 


shown  to  have  the  same  magnitude  and  opposite  phase.  Thus,  whatever  energy  is 
present  in  the  input  at  the  natural  frequency  during  the  first  half  of  the  move  is 


Commands  to  Generate  Robot 


Motion 


Appendix  B 


Many  of  the  FORTH  commands  necessary  to  move  the  robot  were  defined  by 
Benjamin  .75j.  Several  additional  commands  were  written  in  order  to  allow  the 
servo  routines  to  follow  time-varying  reference  setpoints. 

The  servo  control  loops  run  in  the  8031  microprocessors  at  a  1500  Hz  update  rate. 
At  each  pass  through  the  loop,  various  memory  registers  are  checked  to  determine 
subsequent  action.  Calibration,  data-taking,  and  control  output  are  specified  by 
setting  appropriate  bits  in  these  memory  registers  using  the  corresponding  FORTH 
words. 

The  commands  used  to  conduct  experiments  can  be  divided  into  three  groups: 
initialization,  motion,  and  data-storage.  The  initialization  section  sets  up  the  micro¬ 
processors,  allocates  data  storage,  stores  setpoints,  and  zeros  the  axis  position.  The 
motion  section  actually  generates  the  motion.  The  data-storage  section  transfers 
data  from  the  micros  to  the  V.AX  for  processing  and  plotting. 

typical  sequence  of  commands  to  generate  X-axis  response  to  a  versine  refer- 


Initialization: 


PREP* 

XAXIS 

900  E-3  PGAIH 
2  T-MULTIPLIER  ! 

9806  E-ADDR  ! 

INIT-DATA.VARS 

YAXIS 

8156  EJIDDR  ! 

INIT-DATA.VARS 

XAXIS 

SET-LOAD  /U/ffiCKL/DATA/VERSl.DAT 
SET-LOAD  /U/KECKL/DATA/VERS2.DAT 
START-CAL  INFO 
(move  axis  to  zero  position) 

Motion: 

(lift  red  stop  button) 

GO* 

XAXIS 

DATA.*J<0VE* 

Data- storage: 

XAXIS  DATA-TO-VAX  X.DAT 
YAXIS  DATA-TO-VAX  X-ACC.DAT 


Most  of  the  commands  for  initialization  were  developed  by  Benjamin  l75j  and  are 
defined  there.  PREP"*  initializes  the  X  and  Y-axis  microprocessors  and  downloads 
the  servo  routines  from  the  VAX.  The  subsequent  commands  stiffen  the  position 
gain  and  allocate  memory  for  data-taking.  The  SET-LOAD  command  (as  defined  in 


Appendix  D)  downloads  the  setpoints  given  at  each  servo  time  step  from  files  on 
the  VAX  and  stores  them  in  successive  memory  locations  on  the  microprocessor. 
START-CAL  INFO  alerts  the  servo  routine  to  look  for  the  calibration  micro-switch 
to  set.  .As  the  X-axis  is  manually  moved  in  a  negative  direction,  the  position  in 
encoder  counts  will  appear  on  the  terminal  display.  .After  the  calibration  micro¬ 
switch  has  been  reached,  the  position  count  will  zero  out.  and  the  a.xis  will  be  at  its 
zero  position. 

To  generate  motion,  all  limit  switches  must  be  cleared  and  the  red  stop  but¬ 
ton  must  be  released.  Once  this  has  been  done.  GO*  activates  the  servo  routines 
to  enable  the  amplifiers  and  generate  a  voltage  command  output.  The  command 
DATA-ft_MQVE*  (defined  in  .Appendix  D)  tells  the  servos  to  look  at  successive  mem¬ 
ory  locations  for  setpoints  and  sets  up  data-taking.  Position,  current,  and  amplifier 
command  data  are  stored  in  the  X-a.xis  microprocessor,  while  acceleration  data  is 
stored  in  the  Y-axis  micro.  In  order  to  generate  a  simple  step  response,  the  com¬ 
mand  DATA-t_MOVE*  would  be  replaced  by  36000 .  DATA.ft.SET*  to  generate  a  36000 
count  move  while  taking  data. 

The  data-storage  commands  simply  take  the  data  stored  on  each  microprocessor 
and  transfer  them  to  do  unit  conversions  and  to  generate  graphic  plots. 


Microprocessor  Assembly  Code 

Appendix  C 


The  8031  microprocessors  which  run  each  axis  are  programmed  with  three  dis¬ 
tinct  pieces  of  software.  In  addition,  routines  have  been  burned  into  PROMs  residing 
on  the  micro  cards  to  facilitate  communication  and  interrupts. 

The  three  software  programs  are  written  in  8031  assembly  language  and  consist 
of  a  framework  program,  servo  loops,  and  mathematical  routines.  The  servo  loops 
(LOO PS. ASS)  and  mathematical  routines  (MATH. .ASS)  have  been  retained  as  de¬ 
veloped  by  Benjamin  i75i  without  changes.  The  framework  program  establishes  the 
sequence  of  events  during  each  servo  clock  cycle.  A  revised  version  of  this  program 
( FRAMESET. .ASS)  was  written  to  allow  for  time-varying  position  setpoints. 

A  copy  of  the  assembly  code  for  FR.AMESET..ASS  is  given  on  subsequent  pages. 

.A  majority  of  this  program  remains  unchanged  from  the  framework  program  FR.AME..ASS 
written  by  Benjamin.  Two  additional  sections  were  added  to  permit  time- varying 
setpoints.  Section  3  checks  whether  time- varying  setpoints  are  called  for  and  if  so 
fetches  the  setpoint  value  from  the  appropriate  memory  location.  This  memory 
address  is  incremented  during  each  pass  through  the  framework  routine. 

Section  3  also  determines  the  change  in  setpoint  from  the  previous  pass.  This 
is  a  discrete  representation  of  reference  velocity.  Section  4  then  determines  the 


difference  between  this  reference  velocity  and  the  measured  velocity  to  generate  a 


o 


Micro-Processor  Based  Control  Prograii 
Mike  Benjamin 


•••  modified  by  Peter  Meckl,  11-5-87  ••• 

reads  time-varying  setpoints  if  so  enabled 
(located  at  Starting  Address  of  Data  Block-t-B 
and  following) ;  Data  Rata  must  be  2  or  more 

uses  velocity  error  (rather  than  merely 
measured  velocity)  in  PO  loop 

changed  ' jnb  acc.7'  to  ' jnc'  in  data-taking  routine 
to  ensure  that  it  stops  at  right  address 

modified  by  FGM,  3-31-8S  ••• 

saves  Force  data  rather  than  Setpoint  data 

ignores  trouble,  encoder  overrun  bit. 

Pra-Oaflned  Registers  (all  numbers  base  8) 

Reg  40:  Bit  0  -  Jump  to  RAM  bit  set  by  START  com'nd  in  coaaunlcations  program 

Rag  41:  Bit  0  -  Enable  Bit  -  Sat  to  enable  out  put  to  amplifiers 

Bit  1  -  Calibrate  Bit  -  indicates  Calibration  Routine  should  be  run 
Bit  2  -  Calibration  Indicator  -  Set  by  this  program  to  indicate  that 
axis  was  calibrated. 

Bit  3  -  Amplifier  Select  Bit  -  Set  for  use  with  Automatix  Amps 
Cleared  for  use  with  MIT  amps 

Reg  44:  Bit  0  -  Enable  data  taking 

Bit  1  -  Set  externally  to  save  Position  Data 

Bit  2  -  Set  externally  to  save  A/D  Data 

Bit  3  -  Set  externally  to  Save  Output  Data 

ait  4  -  Sat  by  this  program  to  Indicate  full  data  buffer 

-  cleared  by  PDP-11 

Bit  5  -  Set  by  program  to  indicate  data  taking  in  progress 

-  cleared  by  program 

Bit  6  -  Set  to  enable  time-varying  setpoint 

-  Cleared  by  program  at  the  and  of  the  move 

Bit  7  -  Set  by  this  program  to  indicate  that  move  with  time-varying 
setpoints  is  in  progress 

-  Cleared  by  program 

Reg  45:  Data  Rata  -  Data  is  saved  every  M-th  time  through  control  loop 
Rag  46:  Starting  Address  of  Data  Block  -  low  byte 
Reg  47 :  -  high  byte  ■ 

Rag  SO:  Ending  Address  of  Data  Block  -  low  b^e 
Reg  SI:  -  high  byte 

Rag  52:  Current  Address  of  Data  -  low  byte 
Rag  S3:  -  high  byte 

Rag  54:  Sampling  Time  -  low  byte 

Rag  SS:  -  high  byte 

Reg  56:  Address  of  Servo  Routine  -  low  byte 

Reg  57 :  -  high  byte 

Reg  60,61,62:  Currant  position  of  axis  (Rag  60  is  least  significant) 

Reg  63,64,65:  Current  Setpoint  for  axis 

Rag  66,67:  Two's  Compliment  integer  representation  of  OUTPUT  value  for 
amplifiers  -  Loaded  by  Servo  Subroutine 
Rag  70 :  Used  by  servo  subroutine  to  calculate  output  in  idcro-notatlon 


^  V  VV 


Reg  71  -  122;  Scratch  paa  for  servo  couclnea 

Rag  74,75,76;  Must  bo  Loaded  with  the  Speed  for  use  in  the  Servo  subroutine 

Reg  114;  Current  Address  of  Setpoint  -  low  byte 

Reg  115;  -  high  byte 

Reg  116,117,120:  Change  in  Setpoint  in  micro-notation 

Rag  121,122:  Must  remain  unused  to  avoid  conflict  with  velocity  transitions 
whan  using  above  registers  (114-120)  —  (see  loopsvel.ass) 

Rag  123,  124,  125,  126,  and  127  Scratch  pad  for  add  and  multiply  routines 
Reg  130  -  177:  Stack  Registers 


MAIN  SERVO  FRAKENORK  PROCHIAM  ••• 

This  coda  runs  on  a  timed  interrupt  basis  and  is  responsible  for 
Reading  Encoder  and  updating  position  counts 
Loading  Tlsia-vacying  Setpoints  -  if  so  enabled 
Checking  for  calibration  pulse  -  if  we  are  in  calibration  mode 
Checking  Limit  Switches  and  Enable  Bit 
Calling  Servo  Subroutine 
Taking  Data 

Outputing  values  to  PMM  amplifiers 


.  10000 

;  Section  1:  push  items  onto  stack  and 

clr  tcon.4 
push  psw 
push  dpi 
push  dph 
push  acc 
setb  psw.  3 
mov  thO, 59 
mov  tlO>  54 
setb  tcon.4 

;  Section  2;  Read  currant  Position  and 

mov  dptr, *154000 
movx  9dptr,a 
mov  76, *1 
mov  74, #0 

mov  dptr, #140000 
mov  r0,#60 
mov  r5,#0 
movx  a,8dptr 
clr  c 
subb  a,8r0 
mov  c4,a 
mov  75, a 

jnb  acc.7,pos 
mov  r9,#377 
mov  76, *201 
clr  c 
clr  a 
subb  a, 75 
mov  75, a 

pos  mov  a,8r0 
clr  c 
addc  a,r4 
mov  9c0,a 
inc  rO 


.■TIMBR  0  interrupt  routine  at  10000 

castart  timer. 

(Stop  timer  0  for  a  moment 
.■store  things  away 


.■select  register  bank  1 
;load  starting  counts 

.■restart  timer  0 

update  higi  bytes  of  count 

.■address  of  force  d/a 
.■start  convert 

;  initialize  sign/azp  byte  of  speed 
;  init  Imb  of  speed  to  zero 

;  address  of  encoder  count 

.■initialize  high  byte  of  change 
.■fetch  current  encoder  reading 

.■New-reading  -  Old-reading  >  Low-change 
;c4  -  low-change 
;  speed-hmb  •  low-change 

;jua9  ahead  if  positive  change 
;set  High-change  •  -1 
; change  sign  of  speed 


•■take  abs  value  of  change  for  speed 
.■store  as  the  hmb  of  speed 


.■New- reading  •  Low-change  4-  old- reading 
.■Stash  new  reading 


mov  a,9E0 
addc  a,cS 


mov  9  eO , a 
inc  eO 
mov  a,9E0 
addc  a,E5 

mov  9E0,a 


;faech  old-high-Esading 
; Hav-high- Eaadlng 
;  -  old-high  +  high-changa 

.-ataah  naM-hlgh-Eeading 

.-Catch  old-vaEy-high-Eaadlng 
; Na«-vacy-hlgh 

;  -  old-vaEy-high  +  high-changa 

.-ataah  naw-vaty-high-Eeading 


Section  3 :  Load  cuEEant  aatpoint  and  datazmina  changa  in  aatpoint  by 
looking  at  lowaat  byta  changa 


push  dpi 
push  dph 
jnb  44. 6. cal 
jb  44.7, Eaad 
mov  dph, 47 
mov  dpi, 49 
inc  dptE 
inc  dptE 
inc  dptE 
mov  llS,dph 
mov  114, dpi 
aatb  44.7 


;aava  pointez  addzasa  to  ancodaz  count 

;akip  this  if  no  tiaa-vacying  aatpoint 
;iBova  ia  in  pcogzaaa  -  akip  on 
.-load  in  atazting  addz.  of  data  block 

.-fizat  aatpoint  located  at  S_ADDR't-3 


.-atoza  atazting  addz.  of  aatpointa 
.-aat  indicator  that  move  ia  in  pcogzaaa 


read  mov  120,11 
mov  IIS, #0 
mov  dph, 115 
mov  dpi, 114 
movx  a,adptc 
mov  cS,a 
mov  c0,l£3 
clc  c 

aubb  a,9r0 


,-lnltlaliza  aign/axp  byta  of  changa 
,-init  lab  of  changa  to  zaco 
,-load  aatpoint  data  pointaz 

,-Eaad  low  byta  of  new  aatpoint  (lb) 
.-taapocacily  ateca  naw  aatpoint  lb 
,-polnt  to  lo»  byta  of  curcant  aatpoint 

,-Haw-Eaading  -  Old-zaading  •  Low-change 


cjne  a,tl77,naof 
OlE  44.7 
olE  44. S 
a  jap  cal 


,-akip  if  aoza  aatpointa  coming 
;and-of-aatpoint-f lla  caached  (a>177) 
,-uaa  aama  aatpoint  from  now  on 


neoC  mov  117, a 

jnb  acc.7,plu3 
mov  120, *201 
clc  c 
clz  a 
aubb  a, 117 
mov  117, a 


.-atoca  as  hmb  of  changa  •  Low-change 
;juap  ahead  if  positive  changa 
.-cavacsa  sign  of  aatpoint  change 


,-tska  aba  value  of  changa 
.-stoca  as  hmb  of  changa 


plua  mov  a,z< 
mov  9c0,a 
inc  dptc 
movx  a,8dptr 
inc  cO 
mov  gz0,a 
inc  dptr 
0K>vx  a,9dptz 
inc  zO 
mov  9c0,a 
inc  dptc 
mov  115, dph 
mov  114, dpi 


.-stash  naw  setpoint  low  byta 

.-fetch  medium  byta  of  naw  aatpoint 
.-stash  medium  byta  of  new  aatpoint 
.-fetch  high  byte  of  naw  aatpoint 
.-stash  high  byta  of  new  aatpoint 
.-stoca  pointac  to  next  aatpoint 


Section  4:  Datacmina  velocity  acroc  as  position  changa  -  aatpoint  change  to 
conform  to  PD  eontcollac  convention 


xrl  120, *200 
raov  rO,  *04 
mov  rl, *116 
Icall  add2 

cal  pop  dph 
pop  dpi 

;  Section  5 :  Calibrate  Axla  1£  required 

Inc  dph 
jnb  41.1,bb 

jb  41.2,bb 
movx  a,9dptr 
anl  a, *10 
cjne  a,*13,bb 
dec  dph 
leov  a,  *0 
movx  9dpcr,a 
Inc  dph 
mov  rO, *60 
clr  a 

zap  mov  9ra,a 
Inc  rO 

cjne  r0,*66,zap 
aetb  41.2 


;  Section  6;  Initialize  Output  to  zero 

bb  clr  a 

mov  60, a 
mov  66, a 
jb  41.0, lln 
ajmp  out 

!  check  for  limit  avltchea  or  encoder 

11m  movx  a,9dptr 
anl  a, *60 
jz  cont 
clr  41.0 
sjihp  out 

;  Section  0 ;  Jump  to  servo  Routine 

cent  acall  load 
Icall  servo 


;  Section  8:  Data  taking 

jb  44.5,dt0 
jb  44. 4, out 
jnb  44.0, out 

mov  r3, *1 
mov  53,40 
raov  52, 46 
setb  44.5 

dtO  djnz  r3,aut 

;  all  tests  have  been  passed  -  time  to 
mov  r3,45 


/chanqe  sign  of  setpoint  velocity  tern 
; point  to  position  change 
.■point  to  -setpoint  change 
,-add  ->  804  -  804  -  9120 

.-restore  encoder  count  addr.  pointer 


;lnc  dph  once  to  access  one  status 

;bit  41.1  indicates  that  we  are  In 

;  calibration  mode 

.-bit  41.2  Indicates  we  are  calibrated 

; fetch  encoder  status 

.‘Check  for  calib  t  A  4  B  &  Zero  pulse 

;lf  not  at  calibration  pt  skip  ahead 

.-set  dptr  to  encoder  count  register 

.-accum  •  0 

,- clear  count 

.-restore  dptr 

,-r0  •  pointer  to  position  t  setpt  blk 


;  juaip  back  to  clear  more  If  necessary 
.-set  to  indicate  calibration  occured! 


and  check  for  shut  down  conditions 


;  Reg  67, 66  •  0 

;  bit  41.8  Is  enable 
;  If  not  enabled  -  juaip  to  output 

overrun. 

;  fetch  encoder  status 

.-cheek  for  overrun  flag  or  Ibnit  trip 

; if  none  are  set  keep  going ! ! 

.-  clear  enable  bit 

.-if  some  have  been  tripped  -  BAII,  OUT 


,-  load  subroutine  loads  addresses 
;  actual  address  for  servo  provided  by 
;  load  subroutine  from  Reg  56  (  57 


.-we  are  currently  taking  data  -  skip  on 
;  data  buffer  Is  full  -  move  on 
.-  not  taking  data  at  present 

.-  Start  taking  Data  -  Initialize  things 
;  load  In  starting  addr.  of  data  block 

.-set  Indicator 

r3  Is  countdown  for  whan  to  taka  data 

taka  data 

;  initialize  c3 


!  load  data  pointat 


mov  dph, 53 
mov  dpl>  52 
jnb  44.1,dtl 
mov  a, 60 
movx  9dptr, a 
inc  dptr 
mov  a, 61 
movx  9dptr,a 
inc  dptc 

dtl  jnp  44.2,dt2 
puah  dpi 
push  dph 

mov  dptr> #154000 
movx  a.9dpcr 
pop  dph 
pop  dpi 
movx  Sdptr.a 
inc  dptc 
mov  a, #0 
movx  9dptc,a 
inc  dptr 

dt2  jnb  44.3,dt3 
mov  S  /  66 
movx  9dptr,a 
inc  dptc 
mov  a, 67 
movx  9dptc,a 
inc  dptc 

dt3  mov  53, dph 
mov  52, dpi 
mov  a, 51 
clc  c 
subb  a, 53 
jn*  out 
clr  c 
mov  a, 50 
subb  a,  52 
subb  a, #1 
jnc  out 

;  data  block  is  full  -  stop  data  taking 
mov  51,53 
mov  50,52 
sotb  44.4 
clr  44.5 

;  Sactlon  9;  Output  to  Motor 

out  jb  41.3,aout 
clr  a 
mov  r2, #0 
jnb  41.0, put 
mov  c2,#l 
mov  a,  67 
jnb  acc.7,posl 
negl  mov  c2, #3 

clr  c 
clr  a 
subb  a, 66 
sjmp  put 
posl  mov  a, 66 

put  mov  dptr, #152000 

movx  8dptc,a 


;  aca  ho  saving  position  data? 

:  got  position  from  registers  60  &  61 
;  stash 


;  aca  we  saving  A/D  data? 

1  save  dptc 
;  addc  of  A/D  data 
;  fetch  A/D  reading 

;  restore 
;  stash 

;  high  byte  is  zero 


;  ace  we  saving  output  data? 

;  get  output  from  registers  66  t  67 
;  stash 


;  store  away  data  pointer 

;  is  data  buffer  full? 

;  subtract  high  bytes  of  data  addresses 
I  data  not  full 


;  subtract  low  bytes 
;  subtract  an  extra  1 
1  positive  answer  -  keep  going 


!  update  end  of  data  block  markers 

;  raise  flag 
.-lower  flag 


jump  if  we  ace  using  Autoraatix  Anps 

initialize  for  disabled  asp 
if  we  ace  not  enabled  jusp  ahead 
set  for  forward  motion 

test  sign 
negative  output 


change  sign 


address  of  PMM  Mag  for  MIT  amps 
output  magnitude 


addraas  of  PMM  status 
output  status  i  diractlon  bits 


mov  a , r2 

mov  dptr, tlSOOOQ 
movx  9dptr,a 
3  jap  popr 

Tho  following  constand  cauaaa  Initialization  to  occur  at  original  location 
but  glvas  axtra  room  to  finish  frasiawock  program. 

-  lOSOO 

3 jap  Inlt 


aout  mov  r2,t0 

jnto  41.a,apoa 
Inc  c2 

apoa  mov  dptr, tlS2000 

mov  a, 68 
oovx  9dptr,a 
Inc  dpi 

swap  a 

oovx  9dptr,a 
Inc  dpi 
loow  a,  67 
zrl  a, *10 

oowx  9dptr,a 
Inc  dpi 
mows  Sdptr, a 
mov  dptr,  *13000^ 
mov  a, z2 
movs  9dpts,a 

1  Sactlon  8:  Pop  Stack  and  ratura  from 

popr  pop  ace 
pop  dpb 
pop  dpi 
pop  paw 
rati 

sarvo  nop 


'  Initlallza  anabla  conamnd  to  zazo 
juop  If  wa  aran't  anablad 
r2  usad  latar  for  status  byta 
dptr  w  baaa  addrass  of  latch  card' s  d/ 

output  lowast  four  bits 
Incriaant  polntar 
swap  nlbblaa 
output  old  4  bits 
Incrlmant  polntar 

coa^llmant  bit-11  to  changa  Into  right 

; format  for  d/a 

output  high  4  bits 

Incraaant  polntar 

output  to  latch  convartlon 

dptr  ••  addrass  of  anabla  raglstar 

output  anabla  bit 

intarrupt 


;  laava  things  as  thay  wara  found 


;  bogus  labal  to  fill  In  Icall 
;  instruction 


Subroutina  LOAD  -  movaa  tho  addroas  of  tba  suorvo  subroutina  to  tho  and 
of  tha  two  bytos  diractly  following  tho  Icall  instruction. 

This  allows  changing  tha  subroutinas  by  writing  tho  addrass  of  tho  now 


sarvo  routina  Into  locationa  3 

load  pop  dpb 

pop  dpi 
Inc  sp 
Ine  sp 
Inc  d^z 
mov  a, 57 
oovn  8dptr,a 
Inc  dptr 
mov  a,  56 
movx  9dptc,a 
cat 

;  Initialization  Saction  -  this  program 
at  tha  start  of  oparatlon 

-  10700 

Inlt  clc  40.0 


t  57  of  Intamal  RAM. 

;  gat  program  countar  addrass 
from  stack 

;  and  load  Into  data  polntar 


;  foteb  high  byta  of  sarvo  rotlno  addr 
;  stoco  jump  to  addrass 

;  fatcb  low  byta 


is  cun  only  onca 


.-this  coda  goas  at  mlczo-addr  10700 
;claar  jump  to  cam  flag 


mov  i:aiod,  tl 
mov  55, #375 
mov  54, #164 
mov  thO,5S 
mov  CIO, 54 
secb  ccon.4 
mov  iac,  4203 
mov  Ipc, *2 
mov  a, 4315 
anl  44, a 
mov  112, 4377 
mov  113,47 

wait  jnb  40.0, wait  ;  check  which  Is  startup  flag 

clr  40.0  ;  leave  cleared  before  jumping  to  RAM 

push  psw 

anl  psw, 4347  ;  select  register  bank  0 

mov  dpi, rO  ;  load  data  pointer 

mov  dph, rl 
pop  psw 
clr  a 

jmp  3atdpcc  to  ram 

:  The  following  label  is  purely  for  the  assambler  to  check  that  the  above 

;  coda  fits  bafora  naieory  location  11000. 

-  11000 
nop 

;  Tha  following  bogus  label  is  so  that  Che  asseaibler  will  know  where  Che 
math  services  are. 

•  12000 

add2  nop 


.-configure  timer  xero  in  mode  1 
;  inicialixe  servo  race  registers  for 
;  1.5  kHs  sas^ling 

.-load  starting  counts 

.-start  up  ciaar  0 

.-enable  comm,  and  timer  inCarcupcs 
:  sec  priority  of  servo  loop  high 

.-  clear  start  data  and  data  full  bits 
;  Initialize  as^lifier  Max. 


The  FORTH  language  operates  as  a  hierarchy  of  definitions,  in  which  more 
complex  words  are  built  up  from  simpler  words.  These  definitions  are  stored  in  a 
dictionary  when  compiled,  which  resides  on  the  PDF  11/23.  Most  of  the  FORTH 
words  needed  to  run  the  experiments  were  already  contained  in  this  dictionary. 
•Additional  words  were  defined  in  a  file  on  the  V.AX  called  / u/meckl/ forth/ data- 
send.fth  and  were  added  to  the  dictionary  on  the  POP  11/23  using  the  FORTH 
command: 

INTERPRET -VAX-FILE  /U/MECKL/FORTH/DATA-SEND .  FTH 

The  following  glossary  of  FORTH  words  describes  what  each  command  does  and 
specifies  the  input  and  output  for  each  word.  FORTH  operates  on  a  stack,  so  input 
and  output  is  specified  by  the  expressions  surrounded  by  parentheses  and  separated 
by  a  double  hyphen.  The  first  expression  represents  the  input  to  be  placed  on  the 
stack,  while  the  second  expression  represents  the  output  returned  from  the  stack. 
One  or  both  of  these  may  be  absent. 

DATA-TO_VAX  (FILENAME  --  ) 

reads  data  from  the  microprocessor  specified  by  MN  and  transfers  it  to 
the  file  FILENAME  on  the  V.\X. 


VAX.TQ_MICRO  (FILENAME  --  ) 

transfers  the  contents  of  FILENAME  on  the  VAX  to  the  microprocessor 
specified  by  MN. 

SET_LQAD  (FILENAME  --  ) 

transfers  a  sequence  of  setpoints  from  FILENAME  on  the  VAX  to  the 
microprocessor  specified  by  MN  starting  at  an  actual  memory  location 
given  at  the  start  of  the  file. 

ENABLE-MOVE  (  --  ) 

signals  the  framework  routine  for  microprocessor  specified  by  MN  to  start 
servoing  to  setpoints  from  successive  memory  locations. 

DATA.4_MaVE  (  --  ) 

starts  servoing  to  setpoints  from  successive  memory  locations  for  micro 
specified  by  MN  while  taking  data  for  position,  A/D  input,  and  amplifier 
command. 

DATA-4J<0VE*  (  --  ) 

does  DATA_4-M0VE  for  axis  specified  by  .\IN  while  reading  D  data  on 
other  axis  micro  without  moving  that  axis. 

DATA.4_M0VE’»’*  (  —  ) 

does  DATA,4_M0VE  for  X-a.xis  and  servos  to  setpoints  from  successive 
memory  locations  in  Y-axis  micro  while  reading  .\  D  data  on  that  axis. 


DATA.ft_SET*  (DOUBLE  INTEGER  —  ) 


signals  the  framework  routine  for  microprocessor  specified  by  MN  to  start 
following  setpoint  given  by  DOUBLE  INTEGER  while  reading  data  for  po¬ 
sition,  A/D  input,  and  amplifier  command  from  the  moving  axis,  and 
A  D  input  only  from  the  other  axis  micro  without  moving  that  axis. 


